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Kurzfassung 


Maximilian Hochstein 
Entwicklung und Evaluierung einer Kommunikationsgestützten Loka- 
lisierung 


Mit dem Ziel, ein spurgeführtes fahrerloses Transportfahrzeug lokal hoch- 
flexibel und frei navigieren zu lassen, wurde im Rahmen dieser Dissertation 
ein neuartiges, auf Entfernungsmessungen basierendes, kommunikations- 
gestütztes Lokalisierungssystem entwickelt, erforscht, praktisch umgesetzt 
und evaluiert. 

Mit Hilfe einer Tiefenbildkamera, welche an der Decke einer Halle montiert 
ist, wird der Bereich unterhalb der Kamera gescannt und von einer Aus- 
werteeinheit analysiert (siehe Abbildung 0.1). Das Sensorsystem ist in der 
Lage Objekte innerhalb des digitalen Sichtfeldes zu erkennen, sie auf de- 
ren kinematische und geometrische Eigenschaften hin zu untersuchen und 
die gesammelten Informationen über eine Kommunikationsschnittstelle zu 
veröffentlichen. Da eine Identifizierung der einzelnen Fahrzeuge mit Hilfe 
des Kamerasystems schwierig umsetzbar ist, wurde eine neue Herangehens- 
weise erforscht. Basierend auf einem probabilistischen Ansatz konnte eine 
Methode entwickelt und implementiert werden, die es den einzelnen Fahr- 
zeugen erlaubt, auf die kommunizierten Eigenschaften zuzugreifen und sich 
selbst zu identifizieren. Ein Vorteil des neuen Ansatzes ist die Unabhängig- 
keit von Form, Farbe und Größe der Fahrzeuge. Darüber hinaus erhält jedes 
Fahrzeug nicht nur die Informationen über sich selbst, sondern über alle 


Objekte im Sichtbereich der Kamera. 


Kurzfassung 


Abbildung 0.1: Schematische Darstellung des Lokalisierungssystems inklusive des über- 
wachten Bereichs, in dem die fahrerlosen Transportfahrzeuge frei navigieren 
können. 


Für die Aufbereitung der Tiefendaten wurden neue Methoden zur Rausch- 
unterdrückung, Objektstabilisierung und Segmentierung erforscht und im- 
plementiert. Abschließend konnte ein Sensorsystem installiert und ein Test- 
szenario aufgebaut werden. Mit Hilfe eines angepassten Versuchsfahrzeu- 
ges wurden Versuche durchgeführt, mit dem Ziel die maximal mögliche 
Geschwindigkeit des Systems und die Positioniergenauigkeit eines fahrer- 
losen Transportfahrzeuges zu bestimmen. Es konnte gezeigt werden, dass 
Fahrzeuge, die sich auf Basis der kommunikationsgestützten Lokalisierung 
orten, lokal frei navigieren können, ohne dass eine Erweiterung des Fahr- 


zeuges um zusätzliche Sensorik notwendig ist. 
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Abstract 


Maximilian Hochstein 


Development and evaluation of communication-based localization 


Within the scope of this dissertation a novel localisation system, based on di- 
stance measurements was developed, implemented and tested, with the aim 
of allowing a driverless transport vehicle to navigate freely and with high 
local flexibility. With the aid of a depth image camera, which is mounted 
under the hall ceiling, the area below the camera is scanned and analysed by 
an evaluation unit (see figure 0.2). The sensor system is able to detect ob- 
jects within the field of vision, examine their trajectory and their geometric 
properties and publish the collected information via a communication inter- 
face. One of the challenges was to identify the vehicles. Since it is difficult 
to identify the individual vehicles with the help of the camera system, a new 
approach was implemented. Based on a probabilistic approach, a method 
was developed and implemented that allows the individual vehicles to iden- 
tify themselves based on the communicated properties. One advantage of 
the new approach is the independence of shape, colour and size of the vehi- 
cles. In addition, each vehicle not only receives information about itself, but 
also about all objects in the camera’s field of vision. 

In parallel, new methods for noise reduction, object stabilization and seg- 
mentation were developed for processing the depth data. Finally, a sensor 
system was installed and a test scenario was set up. With the help of an 
adapted test vehicle, tests were carried out to determine the maximum pos- 


sible speed of the system and the positioning accuracy of a driverless trans- 
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Abstract 


Abbildung 0.2: Schematic representation of the sensor unit including the monitored area in 
which the driverless transport vehicles can navigate freely. 


port vehicle. It could be shown that the implementation of communication- 


supported localization is possible. 
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1 Einleitung 


1.1 Einleitung und Motivation 


Eine gute Lokalisierung bildet das Rückgrat eines jeden autonom fahrenden 
Fahrzeuges. Nur wenn die aktuelle Position bekannt ist, kann der richtige 
Weg eingeschlagen werden, um das Ziel zu erreichen. Während autono- 
mes Fahren auf öffentlichen Straßen aktuell ein viel diskutiertes Thema ist, 
sind fahrerlose Transportfahrzeuge, so genannte FTF, im industriellen Um- 
feld schon seit Jahrzehnten im Einsatz und bilden einen wichtigen Teil eines 
anhaltenden Automatisierungstrends der letzten Jahre. So steigerte sich zwi- 
schen 2005 und 2015 der Umsatz im Bereich Robotik und Automation um 
76,8 % auf 12,2 Mrd.€, sieht Abb. 1.1. 

Im Rahmen der 4. industriellen Revolution ist nicht nur die Automatisie- 
rung, sondern auch die Digitalisierung in vollem Gange. Produkte werden 
individueller, wodurch sich die Lösgrößen kontinuierlich der eins nähern 
[1]. Flexibel und intelligent sind die neuen Schlagworte, mit denen die 
zukünftige Produktion beschrieben wird und die dabei helfen sollen, die 
zunehmende Individualisierung zu meistern. Die Vernetzung softwaretech- 
nischer, mechanischer und elektronischer Komponenten, sogenannte cy- 
berphysische Systeme, bilden hierfür die Grundlage und werden zu einem 
wichtigen Bestandteil moderner Unternehmen [21]. Kurze Produktzyklus- 
zeiten fordern ein hohes Maß an Flexibilität, um Produktionsanlagen und 
-linien schnell den neuen Bedingungen anpassen zu können. Dazu gehören 
auch Materialflüsse. Da sich in der Regel Transportrouten für fahrerlose 


Transportfahrzeuge einfacher als fest installierte Fördertechnik ändern las- 


1 Einleitung 


sen, werden in immer mehr Bereichen der Intralogistik starre Materialfluss- 
systeme aufgebrochen und durch fahrerlose, autonom agierende, hochflexi- 
ble Transportsysteme ersetzt!. So werden „zukünftige Transportroboter in 
zunehmend unstrukturierten Umgebungen, Umgebungen die von Natur aus 
unvorhersehbar sind, arbeiten."? 

Doch obwohl schon eine Vielzahl unterschiedlicher fahrerloser Transport- 
systeme (FTS) auf dem Markt erhältlich sind „stellt die Digitalisierung der 
Produktion insbesondere den deutschen Mittelstand vor große Herausfor- 


derungen." 


. Während die Umstellungen, hin zu modernen Systemen, für 
große Firmen in der Regel einfacher zu bewältigen sind, übersteigen die not- 
wendigen Investitionskosten oftmals das Budget kleiner und mittelständiger 
Unternehmen. Gerade die notwendigen, hochflexiblen FTS sind oftmals zu 
teuer, während die etablierten spurgeführten Systeme zu unflexibel sind. 

Einen großen Einfluss auf die Flexibilität als auch auf die Kosten und die 
Positioniergenauigkeit hat das zu Grunde liegende Lokalisierungssystem. 
Mit dem Ziel ein hochflexibles, aber dennoch erschwingliches fahrerloses 
Transportsystem für Firmen unterschiedlicher Größe umzusetzen, wurde 
ein neuartiges, kommunikationsgestütztes Lokalisierungssystem entwickelt. 
Basierend auf einem externen Kamerasystem sind Fahrzeuge in der Lage, 
lokal hochflexibel zu agieren, während in Bereichen, in denen kein hohes 
Maß an Flexibilität notwendig ist, auf einfache Systeme zurückgegriffen 
werden kann. Mit diesem Ziel im Hintergrund, werden in der bevorstehen- 


den Dissertation die folgenden forschungsleitenden Fragen beantwortet: 


! vgl. Willibald Günthner 2010: Auszug aus „Internet der Dinge in der Intralogistik", Seite 350 
[13] 

2 vgl. Dieter Fox, Sebastian Thrun und Wolfram Burgard 2005: Aus ihrem Buch ,,Probabilistic 
Robotics“ [30] 

3 vgl. Prof. Dr. Johanna Wanka 2017: Aus dem Vorwort des durch das BMBF veröffentlichten 
Magazins „Industrie 4.0“ [33] 


1.2 Organisation der Arbeit 
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Abbildung 1.1: Statisik: Anhaltende Umsatzsteigerungen in den Bereichen Robotik und Auto- 
mation. 


e Ist die Umsetzung eines kommunikationsgestützten Lokalisierungs- 
systems möglich? 

e Welche Informationen müssen übermittelt werden? 

e Wie gut funktioniert ein solches System? 
Insbesondere, welche Genauigkeit weißt die Positionierung auf 


und welche Geschwindigkeiten können sicher gefahren werden? 


1.2 Organisation der Arbeit 


Begonnen wird die Arbeit, indem in Kapitel 2 ein Überblick über den ak- 
tuellen Stand der Technik gegeben wird. Ferner wird ein Einblick in spur- 
geführte Systeme, frei navigierende Systeme und solche, die über eine ex- 
terne Sensorik verfügen gegeben. Nach der Erläuterung der Vor- und Nach- 
teile der gängigen Systeme, wird der Unterschied zur kommunikationsge- 
stützten Lokalisierung herausgearbeitet. Anschließend wird in Kapitel 3 das 


Gesamtkonzept und die grundlegende Funktionsweise des Systems vorge- 


1 Einleitung 


stellt. Auf Basis dieses Überblicks, wird der Leser in Kapitel 4 ausführlich 
in die Funktionsweise eingeführt, indem einzelne Teilprozesse, die für eine 
erfolgreiche Lokalisierung notwendig sind, beschrieben und deren Zusam- 
menhänge vorgestellt werden. Beginnend mit der Analyse der Messwerte 
der Tiefenbildkamera und der Untersuchung der Randbedingungen, wird 
die Objekterkennung beschrieben. Objekte, die vom Kamerasystem gefun- 
den wurden, werden anschließend in Kapitel 5 auf ihre Eigenschaften hin 
untersucht. Basierend auf den extrahierten Objekteigenschaften kann eine 
Selbstidentifikation durchgeführt werden. In selbigem Kapitel 6 werden die 
gängigen Lokalisierungsprobleme und deren Einfluss auf die Selbstidentifi- 
kation eines fahrerlosen Transportfahrzeuges vorgestellt. Der Nachweis der 
Funktion des Lokalisierungssystems erfolgt in Kapitel 7 in Form mehre- 
rer Versuche. Anschließend werden die Ergebnisse analysiert, zusammen- 
gefasst und diskutiert. Zu guter Letzt wird die Arbeit abgeschossen, indem 


ein umfassendes Fazit gezogen und ein Ausblick gegeben wird. 


2 Stand der Technik 


Neben der fortschreitenden Automatisierung in der Produktion ist auch die 
Automatisierung des Materialflusses stetig vorangeschritten. Zusätzlich zu 
den klassischen Förderstecken wie Rollenbahnen oder Förderbändern wur- 
den seit über 30 Jahren! auch fahrerlose Transportsysteme (FTS) im Mate- 
rialfluss eingesetzt. Ein großer Vorteil dieser FTS liegt in der höheren Fle- 
xibilität im Vergleich zu fest installierten Förderstrecken. FTS können zu 
einem großen Teil die bestehende Infrastruktur, welche parallel von Perso- 
nen und von Personen betriebenen Fahrzeugen genutzt wird, mitnutzen. Im 
Laufe der letzten Jahre haben sich eine Vielzahl an unterschiedlichen FTS 
entwickelt, die sich oft grundlegend voneinander unterscheiden. Ein wich- 
tiges Unterscheidungsmerkmal ist auch hier die Flexibilität. Diese umfasst 
mehrere Bereiche und sollte in zwei unterschiedliche Arten von Flexibilität 
unterteilt werden. Einerseits wird Bezug auf die Möglichkeit genommen, 
neue Transportrouten schnell an eine sich verändernde Infrastruktur anzu- 
passen zu können. Andererseits wird von der Fähigkeit gesprochen, auf akut 
auftretende Umwelteinflüsse reagieren zu können. 

Einen entscheidenden Einfluss auf die Flexibilität hat die zur Lokalisierung 


eingesetzte Sensorik. Diese wird hier in zwei Kategorien unterteilt: 
e Interne Sensorik 
e Externe Sensorik 


Lokalisierungssensorik, welche zum Beispiel in ein fahrerloses Transport- 


fahrzeug integriert ist, fällt in den Bereich der ‚internen Sensorik“, während 


1 1984 setzte Jungheinrich fahrerlose Transportsysteme in der Montage ein [18]. 


2 Stand der Technik 


Sensorik, die nicht Teil eines fahrerlosen Transportfahrzeuges sind zur „ex- 
ternen Sensorik“ gezählt wird. Auf prominente Beispiele beider Arten wird 


in den folgenden Unterkapiteln näher eingegangen. 


2.1 Interne Sensorik 


Bei Fahrzeugen, die über eine interne Sensorik verfügen, sind die Sensoren, 
mit deren Hilfe die Lokalisierung umgesetzt wird, im Fahrzeug integriert. 


Folgend werden einige Systeme erläutert. 


2.1.1 Spurführung 


Die ältesten und auch heute noch meist verbreiteten fahrerlosen Transport- 
systeme sind spurgeführte Systeme. Sie zeichnen sich durch ein hohes Maß 
an Präzision und Zuverlässigkeit aus, gelten jedoch als unflexibel. Sie fol- 
gen einer Spur/Marker, die mit 1-2 Sensoren erkannt werden. 

Obwohl diese Systeme als unflexibel gelten, gibt es unterschiedliche Umset- 
zungen der Spurführung, die verschiedene Freiheitsgrade und somit diverse 
Flexibilisierungsgrade erlauben. Im Folgenden werden drei unterschiedli- 
che, in der Reihenfolge zunehmend flexiblere, spurgeführte Systeme vorge- 


stellt. 
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Abbildung 2.1: Skizzierte Darstellung eines optisch spurgeführten FTF mit Spur. 


2.1 Interne Sensorik 


Induktiv spurgeführte Systeme folgen einer in den Boden eingelassenen 
Leitung, [32] Seite 79f. Da die Leitungen bereits während des Baus der 
Halle in den Boden integriert werden müssen, ist ein späteres Verändern 
der Fahrstrecke nur mit großem Aufwand möglich. Darüber hinaus können 
Hindernisse, die sich auf der Strecke befinden, nicht umfahren werden, da 


die Spur nicht verlassen werden kann. 


Flexibler sind optisch spurgeführte Systeme, [32] Seite 79f. Die Fahr- 
zeuge folgen einer kontrastreichen optischen Linie auf dem Boden, die mit 
der Kamera wahrgenommen werden kann. Bei einer Veränderung der Infra- 
struktur ist ein Verlegen des Streckenlayouts, im Vergleich zur induktiven 
Spurführung, mit weniger Aufwand umzusetzen. Abhängig vom System 
kann eine neue Strecke neu aufgemalt oder aufgeklebt werden. Dennoch ist 
ein Nachteil, dass ein Ausweichen vor Hindernissen, welche sich auf der 
Strecke befinden, nicht möglich ist, da auch hier die Strecke nicht verlas- 
sen werden kann. Grund dafür ist das verhältnismäßig kleine, nach unten 


gerichtete Sichtfeld der Kameras, mit Hilfe derer die Spur erkannt wird. 


gi s 
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Abbildung 2.2: Skizzierte Darstellung eines optisch spurgefiihrten vorausschauend fahrenden 
FTF. 


Im Gegensatz dazu erlaubt das System der vorausschauenden Spurfüh- 


rung ein Ausweichen in begrenztem Maße [16]. Auch hier orientiert sich 


2 Stand der Technik 


das Fahrzeug an einer optischen Linie, welche auf dem Boden aufgeklebt 
wird. Die nach vorne gerichtete Kamerasicht erlaubt es die Spur auch dann 
noch zu erkennen, wenn sich das Fahrzeug neben dieser befindet. Eine Än- 
derung des Streckenlayouts kann durch ein verändertes Aufkleben der opti- 


schen Linie bewerkstelligt werden. 


2.1.2 Freie Navigation 


Der Gegensatz zu Spurführung ist die freie Navigation. Bei spurgeführten 
Systemen gibt es große Unterschiede bezüglich der Flexibilität, dennoch 
können sich die Fahrzeuge nicht vollständig von der Spur lösen und frei 
über eine Fläche fahren. 

Deutlich flexiblere Systeme sind solche der freien Navigation. Die Fahr- 
zeuge orientieren sich nicht an einer Leitlinie, sondern an Markern oder an 
Sendern die in der Umgebung angebracht werden oder an der Umgebung 
selbst. Mit Hilfe dieser Umgebungsinformationen können die aktuelle Po- 
sition und Orientierung berechnet werden, während sich die Fahrzeuge frei 
bewegen. Solche Systeme zeichnen sich durch ein hohes Maß an Flexibilität 
aus, sowohl in Hinblick auf mögliche Infrastrukturänderungen, als auch auf 


sich akut ändernde Umgebungsbedingungen. 


Einer der prominentesten Vertreter der freien Navigation ist die Lasernavi- 
gation, [32] Seite 83f. Über einen rotierenden Laserstrahl werden Entfer- 
nungen zu reflektierenden Markern gemessen. Diese sind an den Wänden 
einer Halle angebracht, auf einer Höhe oberhalb der Köpfe der Mitarbeiter. 
Auf Basis der bekannten Anordnung der Marker und der ermittelten Ent- 
fernungen, kann die Position des Fahrzeuges trianguliert werden. Solche 
Systeme gelten als flexibel in Bezug auf Streckenlayoutänderungen. Neue 
Strecken können schnell eingelernt werden, ohne dass Infrastrukturänderun- 


gen notwendig sind. Trotzdem folgen die Fahrzeuge fest einprogrammierten 
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Routen, die sie nicht verlassen können. Hindernisse, welche im Weg stehen, 


können nicht umfahren werden. 


Ein ähnliches Verfahren, bei dem sich das System jedoch an natürlichen 
Markern orientiert, wird SLAM genannt. SLAM steht für „simultaneous 
location and mapping“ und beschreibt ein Verfahren, welches anhand von 
Sensordaten eine Karte der Umgebung erstellt (siehe Abbildung 2.3), um 
diese zur Navigation zu nutzten. Ein häufig verwendetes Sensorsystem ist 
der Laserscanner, mit dem meist in einer waagrechten Schnittebene Ent- 
fernungen zu umliegenden Objekten und Wänden ermittelt werden. Der 
Vorteil dieses Verfahrens ist, dass keine zusätzliche Infrastruktur benötigt 
wird. Bei fahrerlosen Transportfahrzeugen wird der Laserscanner häufig in 
einer Höhe von ca. 20 cm angebracht, wodurch nicht nur Wände und Säu- 
len, sondern auch Hindernisse erkannt werden. Neue Strecken müssen nicht 
eingelernt werden, da kleinere Veränderungen der Umgebung automatisch 
erkannt und die hinterlegten Karten aktualisiert werden können. Das Sys- 
tem erkennt selbstständig, ob eine Anpassung der Wegstrecke notwendig ist 
und ermittelt automatisch eine neue Route. Systeme, die auf dem SLAM- 
Verfahren basieren, werden auf Grund der schnellen Anpassungsfähigkeit 
als hochflexibel eingestuft. Die Nachteile dieser Systeme sind eine deutlich 
schlechtere Positioniergenauigkeit und hohe Kosten für die Sensoren im 


Vergleich zu spurgeführten Systemen. 


2.2 Externe Sensorik 


Neben Systemen, deren Sensoren in den Fahrzeugen verbaut sind, gibt es 
auch solche, die über keine eigenen Sensoren verfügen und von einem ex- 
ternen System abhängig sind. Der Vorteil externer Sensorik besteht darin, 
dass mehrere Fahrzeuge mit nur einem Sensor lokalisiert werden können. 


Da die Fahrzeuge selbst über keine eigene Sensorik verfügen, können sie 


2 Stand der Technik 


Laserscanner 


Umgebung 


Abbildung 2.3: Mit Hilfe eines Lasers wird der Raum in einer horizontalen Schnittebene 
vermessen und nach geometrischen Merkmalen gesucht, um anschließend die 
Lokalisierung durchzuführen. 


kostengünstiger produziert und z.B. für große Fahrzeugflotten verwendet 


werden. 


Umgesetzt wurde ein solches Kamerasystem auf Basis einer externen Farb- 
kamera von Daniel Pizarro et al. [25]. Die Schwierigkeit besteht darin, das 
Fahrzeug vom Hintergrund zu unterscheiden und seine Position zu erken- 
nen. Die Identifikation erfolgt mit Hilfe eines geometrischen Modells. Ab- 
bildung 2.4 zeigt das Fahrzeug, aufgenommen mit Hilfe einer monochro- 
matischen Kamera. Die gefundenen markanten, geometrischen Stellen sind 
durch grüne Kreise gekennzeichnet und helfen das Fahrzeug vom Hinter- 
grund zu unterscheiden, es zu erkennen und dessen Position zu bestimmen. 
Die geometrischen Besonderheiten, in Form von Kanten und Farbgebun- 
gen, werden automatisch ermittelt. Hierfür wird das Fahrzeug analysiert, 
während es eine Lerntrajektorie abfährt. 

Während die Sensorik durch die Verwendung einer simplen monochromati- 
schen Kamera sehr günstig ausfällt, birgt das System auch einige Nachteile. 
Damit sich das Fahrzeug von der Umgebung abhebt und gut zu erkennen 


ist, muss der observierte Raum gut ausgeleuchtet sein. Sollen mehrere Fahr- 
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Abbildung 2.4: Erkennen eines Fahrzeuges auf Basis von geometrischen Eigenschaften unter 
Verwendung einer externen Kamera. 


zeuge erkannt und deren Position bestimmt werden, müssen diese unter- 
schiedliche geometrische Formen aufweisen. Darüber hinaus sollte sich die 
Form des Fahrzeuges im laufenden Betrieb nicht ändern. Deshalb besteht 
bei diesem System bei der Aufnahme eines Ladungsträgers das Risiko einer 
fehlerhaften Erkennung. Nachteilig wirkt sich auch aus, dass nur Objekte 
erkannt werden können, welche zuvor eine Lerntrajektorie abgefahren ha- 
ben. Menschen und Objekte, die diesen Prozess nicht durchgeführt haben, 
können nicht erkannt werden. Aus diesem Grund ist keine Navigation mög- 
lich, wenn die Fahrbahn durch Hindernisse versperrt wird. Da diese nicht 


erkannt werden, besteht das Risiko einer Kollision. 


Einen ähnlichen Ansatz verfolgten Jae-Hong Shim und Young-Im Chob 
[29]. Verwendet wurden zwei Kameras, mit deren Hilfe sowohl ein Fahr- 
zeug, als auch Hindernisse erkannt werden können. Die Verwendung zweier 
Kameras mit entgegengesetzten Blickrichtungen, bringt einige Vorteile mit 
sich. Ziel war es, wie in Abbildung 2.5 gezeigt, ein Fahrzeug autonom durch 


einen Gang navigieren zu lassen. Dabei ermittelte das Fahrzeug nicht nur 


11 


2 Stand der Technik 


Abbildung 2.5: Roboter navigiert frei durch einen Korridor. 


seine eigene Position, sondern auch die Positionen diverser Hindernisse in 
Form unterschiedlicher Objekte. 

Um dieses Ziel zu erreichen, werden in einem ersten Schritt die Bilder der 
beiden Kameras in eine Draufsicht transformiert und übereinander gelegt 
(siehe Abbildung 2.6). Durch die Verwendung zweier Bilder können die 
von den Objekten erzeugten Schatten herausgerechnet werden. Vorberei- 
tend müssen die beiden Kameras kalibriert werden. Die perspektivischen 
Verzerrungen der Kameras werden mit Hilfe einer schachbrettartigen Vorla- 
ge, welche während der Systemkalibrierung auf den gesamten Boden gelegt 
wird, herausgerechnet. Nach der Kalibrierung können die Grundflächen und 
die Position der sich im Raum befindenden Objekte ermittelt werden. Ba- 
sierend auf den von den Kameras erhaltenen Daten ist das Fahrzeug in der 
Lage, eine Route durch den Gang zu bestimmen, die einen ausreichend gro- 
ßen Abstand zu den einzelnen Hindernissen aufweist. In Abbildung 2.6 ist 
die errechnete Route mit den einzelnen Wegpunkten als Draufsicht darge- 
stellt. Zu erkennen sind auch die Formen der erkannten Hindernisse und 
deren Mittelpunktposition. Das eingezeichnete Gitter ist virtuell und dient 
lediglich dem Betrachter als Orientierungshilfe. 
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Abbildung 2.6: Abbildung der resultierenden Draufsicht aus den beiden Kameraperspektiven. 
Dargestellt ist die geplanten Route (gelb), die tatsächlich gefahrenen Strecke 
(rot) und die Konturen der Hindernisse inklusive deren Mittelpunkte. 


Zusammenfassend können mit dem hier verwendeten Verfahren nicht nur 
das Fahrzeug, sondern auch Hindernisse erkannt werden. Darüber hinaus 
wird die Form der Fahrzeuge erkannt, ohne dass zuvor eine Einlernfahrt 
durchgeführt werden muss. Trotzdem ist ein großes Maß an Vorbereitung 
notwendig, bevor eine Navigation im überwachten Gebiet durchgeführt wer- 
den kann. Nachteilig ist außerdem, dass der Raum gut ausgeleuchtet sein 
muss, um mit Hilfe der Kameras genügend Daten sammeln zu können. 
Auch eine Fahrzeugidentifikation ist nicht möglich und Tests mit mehreren 
Fahrzeugen wurden nicht durchgeführt. Obendrein ist die Nachbereitung 
der Rohdaten sehr aufwändig. 


Ziel der nachfolgend entwickelten kommunikationsgestützten Lokalisie- 
rung ist es, anknüpfend an den Stand der Technik, eine Lokalisierung zu 
entwickeln, welche sowohl auf einem externen Kamerasystem beruht, als 
auch mehrere Fahrzeuge erkennen kann und ohne eine aufwändige Kali- 


brierung auskommt. 
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3 Gesamtkonzept 


Die hier vorgestellte kommunikationsgestützte Lokalisierung hängt von ei- 
nem Zusammenspiel unterschiedlicher Prozesse ab. Die folgende Beschrei- 
bung des Gesamtkonzeptes gibt einen Überblick, um die in Kapitel 7 fol- 


genden Forschungsergebnisse und Funktionsanalysen einordnen zu können. 


Blackboard als Kommu- 
nikationsschnittstelle, 


Kameragestützte (10): ; 
Objekterkennung Fet 


x:45, y:386, v:0. 2 / AN tne 
.  x:96, y:312, v:0, 5:0, / es 

x:97, y:402, v:0, 3:0, 

x:99, y:16, v:0,3;, 

x:423, y:68, v:0, 5, 


Selbsterkennende FTF 


Abbildung 3.1: Skizzierte Darstellung des Systemaufbaus und dessen Bereiche Sensorsys- 
tem (1), auf dem die kameragestützte Objekterkennung (1b) stattfindet, die 
Kommunikationsschnittstelle (2) und das fahrerlose Transportfahrzeug (3). 


Die herausragenden Merkmale des hier erforschten externen Sensorsystems 
sind, dass keine weiteren kostspieligen Sensoren in den einzelnen Fahr- 
zeugen verbaut werden müssen. Darüber hinaus kann das Sensorsystem, 
bestehend aus einer Tiefenbildkamera und einer Auswerteeinheit, mehre- 


re Objekte gleichzeitig detektieren und analysieren. Ein Nachteil ist jedoch, 
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dass es schwierig ist, einzelne Fahrzeuge zu identifizieren. Transportiert ein 
Fahrzeug zum Beispiel einen Ladungsträger, der die gesamte Sicht auf das 
fahrerlose Transportfahrzeug (FTF) verdeckt, wie in Abbildung 3.2 darge- 
stellt, ist eine Identifizierung des Fahrzeuges über das Kamerasystem nicht 
mehr möglich. 

Aus diesem Grund wurde ein neuartiger Ansatz entwickelt, bei dem das 
Sensorsystem alle sichtbaren Objekte analysiert, diese jedoch nicht identi- 
fiziert. Die Identifikation findet auf den Fahrzeugen selbst statt, indem über 
eine Kommunikationsschnittstelle auf die Ergebnisse der Analysen des Sen- 
sorsystems zugegriffen wird und diese mit den eigenen Fahrzeugparametern 
verglichen werden. Innerhalb des überwachten Bereichs können Fahrzeuge 
sowohl auf odometrische Daten, oder auf die des Sensorsystems zurück- 
greifen, um sich zu lokalisieren und zu navigieren. Abhängig vom aktuellen 
Lokalisierungsproblem, werden auf Basis eines probabilistischen Ansatzes 
die internen Messwerte so lange mit denen des Sensorsystems verglichen, 
bis eine Zuordnung möglich ist. 

Das Lokalisierungssystem kann in drei übergeordnete Bereiche unterteilt 
werden (siehe Abbildung 3.1): 


1. Sensorsystem zur Erkennung der Objekte 
2. Kommunikationsschnittstelle 
3. Fahrerloses Transportfahrzeug 


untergliedert werden. Das externe Sensorsystem wird, gemäß Punkt 1 in 
Abb.3.1, unterhalb der Hallendecke in einer möglichst großen Höhe über 
dem zu überwachenden Bereich installiert, um ein möglichst großes Sicht- 
feld zu erhalten. Es besteht aus einer Tiefenbildkamera, welche mit Hilfe der 
„time of flight“-Technik (ToF), Entfernungen in einem Raster von 512 auf 
424 Pixel misst [24]. Mit dem Ziel, ein preiswertes und robustes Lokalisie- 
rungssystem zu entwickeln, wurde, anstelle einer Farbkamera, eine Tiefen- 


bildkamera als Sensor verwendet. Ein Vorteil der Tiefenbildkamera ist, dass 
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für die Auswertung weniger Rechenleistung benötigt wird, wodurch ein- 
fachere Auswerteeinheiten verwendet werden können. Der Bildausschnitt 
unter Punkt 1b ist eine grafische Darstellung der einzelnen Entfernungs- 
messungen, bzw. des ermittelten Höhenprofils, wobei dunklere Grauwerte 
für kürzere Entfernungen stehen. Auf der Auswerteeinheit werden die Tie- 
fendaten analysiert, Objekte gefunden, die in Abbildung 3.1 unter Punkt 
1b als dunklere Bereiche dargestellt werden. Darüber hinaus werden geo- 
metrische und kinematische Eigenschaften der einzelnen Objekte ermittelt. 
Anschließend werden alle Informationen zu allen Objekten in einer Nach- 
richt zusammengefasst und in regelmäßigen zeitlichen Abständen über eine 
Kommunikationsschnittstelle (siehe Abbildung 3.1 Punkt 2) veröffentlicht. 
Als Kommunikationsschnittstelle wird das lokale Netzwerk (engl.: „local 
area network“, kurz: „LAN“) in Kombination mit dem MQTT-Protokoll 
(siehe Abschnitt 5.4) verwendet. Fährt ein Fahrzeug (siehe Abbildung 3.1 
Punkt 3) in den überwachten Bereich, greift es über die Kommunikations- 
schnittstelle auf die publizierten Informationen zu. Auf Basis dieser Daten 
und hinterlegter geometrischer Fahrzeugparameter, ist das Fahrzeug in der 
Lage, sich aus der Menge der veröffentlichten Objekten selbst zu erkennen 
und dadurch seine Position kontinuierlich zu überprüfen und gegebenenfalls 
zu korrigieren. 

Darüber hinaus erhält das Fahrzeug Informationen über alle anderen Ob- 
jekte und Verkehrsteilnehmer im überwachten Bereich. Unter Berücksichti- 
gung aller Hindernisse ist somit eine freie Navigation möglich. 

In den folgenden Kapiteln wird auf den Aufbau, die Algorithmen und die 
Implementierung des Systems eingegangen. Basierend auf einer Analyse 
der Rohdaten des Sensors, werden Verfahren umgesetzt, mit deren Hilfe 
Störeinflüsse wie Rauschen und Kameraneigung korrigiert werden können. 
Anschließend wird die Segmentierung der zusammengehörenden Bildpunk- 
te erläutert und diskutiert, um am Ende von Kapitel 4 die relevanten Punkte 


in eine Draufsicht zu transformieren. 
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Kamerasystem 
ae: 


Kamerasichtfeld— 
_-— Ladungstrager 


Abbildung 3.2: Schematische Darstellung der Identifikationsproblematik durch eine Verde- 
ckung. 


Die Extraktion der Objekteigenschaften erfolgt in Kapitel 5. Erläutert wer- 
den die Ermittlung der Position, der Geschwindigkeit, der Fahrzeugorientie- 
rung und der geometrischen Eigenschaften wie Größe, Höhe und Form. Am 
Ende des Kapitels werden die Kommunikationsschnittstelle, das Kommu- 
nikationsprotokoll, die Nachricht, als auch die Implementierung der Nach- 
richtenübertragung beschrieben. 

Abschließend wird in Kapitel 6 die probabilistische Identifikation am Bei- 


spiel des Testfahrzeuges erläutert. 
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4 Objekterkennung 


Die Objekterkennung stellt den ersten Prozessschritt der Lokalisierung dar 
und wird in der Auswerteeinheit des Sensorsystems umgesetzt. Bevor die 
Eigenschaften für eine spätere Identifikation eines Fahrzeuges ermittelt wer- 
den können, muss die Kamera initialisiert, d.h. die Rohdaten der Tiefenbild- 
kamera müssen analysiert, aufbereitet und gegebenenfalls müssen Fehler 
korrigiert werden. 

Zuvor ist jedoch eine kurze Definition des Begriffs „Objekterkennung“ an- 
gebracht. Entgegen der allgemeinen Verwendung des Begriffes „Objekter- 
kennung“, bei dessen Gebrauch die Identifizierung eines bestimmten Objek- 
tes gemeint ist, wird er im Kontext dieser Dissertation differenziert einge- 
setzt. Die tatsächliche Identifizierung eines Objektes wird folgend mit „Ob- 
jektidentifizierung“ angegeben. Im Unterschied dazu beschreibt die „Ob- 
jekterkennung™ lediglich die Feststellung, dass ein Objekt vorhanden ist, 
ohne zu wissen, um was für ein Objekt es sich handelt. 

Alle verwendeten Messdaten wurden mit der Tiefenbildkamera „Kinect 2“ 
der Firma Microsoft erhoben. Sie besitzt eine Auflösung von 512 auf 424 
Pixel und wurde oberhalb der Versuchsfläche des IFL in einer Höhe von 
5,78 m über dem Hallenboden angebracht. Aus dem Sichtfeld von 70,6° in 
der Horizontalen und 60° in der Vertikalen ergibt sich eine maximale zu 
überwachende Gesamtfläche von 54,59 m? [24]. 


Die Analyse der Messwerte erfolgt in Anlehnung an eine bereits durch- 
geführte Untersuchung [34], die zum Ziel hatte, die optischen Fehler der 


Tiefenbildkamera zu untersuchen. Da die Fehler stark von der Entfernung 
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des Objektes zur Kamera abhängen, wurden gemäß Abbildung 4.1 Versuche 
in den drei Entfernungen 0,7 m, 1,4 m und 2,1 m von der horizontalen Mitte 
einer planen Oberfläche durchgeführt. Bei dem Objekt selbst handelte es 
sich um eine plane Fläche, die orthogonal zur Kamerablickrichtung ange- 
ordnet war. Für die Analyse wurden 100 Einzelbilder aufgezeichnet und die 


einzelnen Messwerte gemittelt. 
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Abbildung 4.1: Darstellung der Ergebnisse einer Analyse der Tiefenbilddaten für unterschied- 
liche Entfernungen zur Oberfläche. In der linken Spalte werden die Messab- 
weichungen (offset) zu den realen Werten abgebildet und in der rechten Spalte 
die zugehörigen Standardabweichungen (stdev) [34]. 


4.1 Kamerainitialisierung 


Linksseitig dargestellt sind die Abweichungen von der tatsächlichen Ent- 
fernung zur Grundfläche und rechtsseitig die zugehörigen Standardabwei- 
chungen. Festgestellt wurde ein Versatz pro Bildpunkt, der hauptsächlich 
vom Abstand des Bildpunktes zur Bildmitte abhängt. Zu erkennen ist, dass 
die Abweichungen bei einer Entfernung von 1,4 m am geringsten ausfal- 
len, während die Standardabweichung bei zunehmender Entfernung größer 
wird. Ein deutlicher Anstieg der Standardabweichung ist vor allem im äu- 


Beren Bildbereich zu erkennen. 


4.1 Kamerainitialisierung 


Die Analyse der Rohdaten spielt eine wichtige Rolle im Lokalisierungspro- 
zess. Eigenschaften wie die Form der Objekte, deren maximale und minima- 
le Höhe als auch die Positioniergenauigkeit sind direkt abhängig von der Gü- 
te der gemessenen Entfernungen. Angelehnt an den von Wasenmiiller und 
Stricker [34] durchgeführten Versuchen wurden Untersuchungen durchge- 
führt, mit deren Hilfe die Güte der Messwerte in einer Entfernung von 5,78 
m über dem Boden ermittelt wurde. Zu den von Wasenmüller durchgeführ- 
ten Versuchen war neben der deutlich größeren Entfernung zur Grundfläche 
auch eine nicht orthogonal zur Grundfläche ausgerichtete Kamera ein Un- 
terschied (siehe Abbildung 4.4). 


4.1.1 Sichtung der Rohdaten 


Die Rohdaten basieren auf den von der Tiefenbildkamera errechneten Ent- 
fernungswerten. Mit dem Ziel eine möglichst große Fläche für die Lokali- 
sierung abzudecken, wurde die Kamera an der Hallendecke angebracht und 
grob Richtung Hallenboden ausgerichtet. Abbildung 4.2 zeigt eine visua- 
lisierte Darstellung der Entfernungsmessungen. Je nach Entfernung wurde 
jedem Bildpunkt ein Grauwert zugeordnet, wodurch die Umrisse der Ob- 


jekte und deren Höhenprofil sichtbar gemacht werden. Auf dem Bild ist 


21 


4 Objekterkennung 


Abbildung 4.2: Visualisierte Darstellung der unkorrigierten Tiefendaten eines Einzelbildes 
mit verschiedenen Objekten: Linie (a), drei Kartons unterschiedlicher Größe 
(b), Versuchsfahrzeug (c), Übergabestelle mit Ladungsträger (d), Tisch (e) 
und aufrecht stehende Palette (f) 


ein Szenario dargestellt, in dem auf dem Hallenboden mehrere Linien auf- 
geklebt wurden (a), sich zusätzlich drei Kisten mit unterschiedlichen Hö- 
hen und Ausmaßen (b), ein Versuchsfahrzeug (c), eine Übergabestelle für 
Kleinladungsträger (d), ein Tisch (e) sowie einer hochkant aufgestellten Eu- 
ropoolpalette (f) befinden. Ziel Filterung und Bereinigung der Rohdaten 
damit am Ende nur noch die relevanten Objekte übrig bleiben. 

Die Auswertung des Kamerabildes in Abbildung 4.2 lässt bereits erste 
Rückschlüsse auf die Qualität zu. Da die Messwerte, die dem Boden zu- 
geordnet werden können, bereits in einer Ebene liegen, kann davon aus- 


gegangen werden, dass die Kamera bereits nivellierte Daten und nicht die 
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tatsächlichen Entfernungen zur Verfügung stellt. Des weiteren führen nicht 
alle Messungen zum Erfolg. Weiße Bildpunkte bedeuten, dass keine erfolg- 
reiche Messung durchgeführt werden konnte und keine Entfernung ermittelt 
wurde. Ein Grund für nicht erfolgreiche Messungen ist der leicht reflektie- 
rende Hallenboden. Ist die Spiegelung zu stark und der Einfallswinkel zu 
klein, wird ein zu großer Teil des Laserstrahls von der Kamera weg reflek- 
tiert, so dass das empfangene Restlicht für eine Entfernungsmessung nicht 
ausreichend ist. Weiße, aufgeklebte Linien auf dem Hallenboden und matte 
Objekte, streuen das Licht deutlich stärker als der Boden selbst, weshalb es 
zu weniger Fehlmessungen kommt und sie besser zu erkennen sind. Im Ka- 
meralot ist die erfolgreiche Aufnahme von Messwerten wahrscheinlicher. 
Darüber hinaus ist an den Helligkeitsunterschieden auf eigentlich planen 
Oberflächen zu erkennen, dass die Entfernungsmesswerte einem starken 
Rauschen unterliegen. Bei genauer Betrachtung kann ein leichter Hellig- 
keitsverlauf erkannt werden. Die Bildpunkte im unteren, linken Bildaus- 
schnitt sind im Schnitt ein wenig heller, als die im gegenüber liegenden 
Bereich des Bildes, rechts oben. Dieser Verlauf deutet auf einen systemati- 
schen Fehler hin, der auf eine Schiefstellung der Kamera zurück zu führen 
ist. 

Um die Kameraschiefstellung besser beurteilen zu können wurden in Ab- 
bildung 4.3 die Messergebnisse aus 100 Einzelbildern übereinandergelegt 
und gemittelt. Anschließend wurde ein tief liegender Bereich in der unte- 
ren linken Bildecke ausgewählt (in Abbildung 4.3 schwarz umrandet), eine 
durchschnittliche Entfernung ermittelt und diese als Abstand, zu einer zur 
Kamerablickrichtung orthogonalen Referenzebene, definiert (siehe Abbil- 
dung 4.4). Die Differenz zwischen der gemessenen Entfernung eines Bild- 
punktes und der Referenzebene wird als Fehler in Form einer Farbe aus der 


Farbverlaufsdarstellung „Jet Colormap“ dargestellt. 
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Abbildung 4.3: Visualisierte Darstellung der Messwertunterschiede aller Entfernungsmessun- 
gen zur mittleren Entfernung im schwarz markierten Bereich. Alle Entfernun- 
gen sind über 100 Einzelbilder hinweg gemittelt. 


Aus Abbildung 4.3 geht hervor, dass der Fehler sowohl in horizontaler, 
als auch in vertikaler Richtung zunimmt. Die Kamera weist demnach ei- 
ne Schiefstellung sowohl in horizontaler als auch in vertikaler Richtung auf. 
Messpunkte, die weiter als 20cm von der Referenzebene entfernt sind, wer- 
den dunkelrot dargestellt. Der durch die Schiefstellung der Kamera verur- 
sachte Fehler wirkt sich enorm auf die Messwerte aus. Er beträgt sowohl in 


horizontaler als auch in vertikaler Richtung deutlich über 20 cm. 


4.1.2 Neigungsausgleich 


Da die Schiefstellung der Kamera einen deutlich größten Einfluss auf die 
Messwerte aufweist als das Rauschen, wird sie zu Beginn ausgeglichen, 
bevor weitere Untersuchungen durchgeführt werden. Ziel ist es, auf Basis 
der Messwerte eine Steigung zu ermittelt, durch die die Schiefstellung wie- 


dergegeben werden kann. Gestützt auf den errechneten Steigungen können 


24 


4.1 Kamerainitialisierung 


Kamerasystem 


yA 
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Bodenebene 


Abbildung 4.4: Schematische Darstellung der Kameraschiefstellung zum Hallenboden. 


zwei Funktionen hergeleitet werden, mit denen die Schiefstellung in hori- 
zontaler, als auch in vertikaler Richtung ausgeglichen werden können. 

Die Bestimmung der Steigung erfolgt unter Zuhilfenahme der Methode der 
kleinsten Quadrate [10]. Als Datengrundlage dienen die Messwerte aus den 
Entfernungsmessungen. Bei Betrachtung der visualisierten Messwerte aus 
Abbildung 4.5, ist zu erkennen, dass die Werte im Zentrum des Bilder we- 
niger stark Rauschen als weiter außen liegende Messwerte. Darüber hin- 
aus wurde nur Messwerte des Hallenbodens aufgenommen, um eine Ver- 
fälschung der Ergebnisse zu vermeiden. Abbildung 4.5 zeigt den gewählten 
quadratischen Ausschnitt in Form eines roten Rechteckes, dessen Zentrum 
mit dem Bildmittelpunkt übereinstimmt und eine Kantenlänge von 100 auf 
100 Bildpunkten aufweist. 

In Abbildung 4.6 sind die ermittelten Abstandswerte z zur Kamera in hori- 
zontaler Richtung x und in vertikaler Richtung y dargestellt. Die Abstand- 
werte z sind in mm angegeben, während die Richtungen x,y in Pixel bzw. 
Bildpunkten wiedergegeben werden. In beiden Schaubildern ist eine fallen- 


de bzw. eine steigende Tendenz der Abstandwerte zu erkennen. Die Mess- 
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Abbildung 4.5: Visualisierte Darstellung der unveränderten Tiefendaten eines Einzelbildes 
mit markiertem Ausschnitt, aus dessen Innerem die Messwerte für die Nei- 


gungsbestimmung verwendet wurden. 


werte wurden jeweils mit einem linearen Fit angenähert. Hierbei ist die all- 


gemeine Funktion für eine Gerade gegeben durch: 


fœ = H+ Q: x. 


Sie setzt sich wie folgt aus Œo und @; zusammen: 


und a _ _ 
Ya — 2) -9) 
0 = ’ 


Li (xi)? 


wobei die Mittelwerte x und y wie folgt berechnet werden: 
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(4.1) 


(4.2) 


(4.3) 


4.1 Kamerainitialisierung 


(4.4) 


Die resultierenden Funktionen, f(x) und fy), sind in den Abbildungen 4.6 in 


Form zweier roter Geraden dargestellt. 


5950 - Neigung - horizontal Neigung - vertikal 
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Abbildung 4.6: Messwerte, welche verwendet wurden, um die Ausgleichsfunktion zu bestim- 
men 


Mit Hilfe der beiden resultierenden Ausgleichsfunktionen kann nun die 
Sollentfernung eines jeden Bildpunktes, abhängig von dessen Koordina- 
ten, berechnet und auf eine feste Entfernung geeicht werden. Die feste Ent- 
fernung ergibt sich aus dem Mittelwert aller Abstandswerte innerhalb des 
quadratischen Ausschnitts 4.5 und beträgt 5778 mm. 
Abschließend wurde die Differenz aus der gemessenen Entfernung und der 
Sollentfernung auf die feste Entfernung addiert und somit die Auswirkung 
der Kameraneigung neutralisiert. Die beiden resultierenden Ausgleichs- 
funktionen sind: 

F(x) = 5921,74 — 1,0503x (4.5) 


in horizontaler Richtung und 
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fy) = 5644,24 + 0,643y (4.6) 


in vertikaler Richtung. 


Das Ergebnis der Anwendung der Ausgleichsfunktionen ist in Abbildung 


4.7 wiedergegeben. Es ist zu erkennen, dass die Schiefstellung der Kamera 


erfolgreich ausgeglichen wurde. 


20 cm 


Bunysiemqy 


Ocm 


Abbildung 4.7: Visualisierte Darstellung des Höhenabweichungen zur Bodenebene nach dem 
Neigungsausgleich 


Der dargestellte Fehler entspricht den Abweichungen der gemessenen und 
nivellierten Entfernungen zum Mittelwert. Die restlichen Abweichungen 


sind auf ein Rauschen der Messwerte zurück zu führen. 
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4.1.3 Lotfussposition 


Der Lotfusspunkt der Kamera ist ein wichtiger Parameter, der für eine 
spätere Transformation der Ergebnisse notwendig ist. Die Berechnung der 
Lotfußposition kann bei der eingesetzten Kamera, im Gegensatz zum Nei- 
gungsausgleich, jedoch nicht mit den nivellierten Werten der Tiefenbild- 
kamera bestimmt werden. Eine Rekonstruktion der realen Messwerte ist 
erforderlich. 


Kamera 


Kameralot 


Lotfußpunkt 


Z 
\ 


Bildmittelpunkt 


Abbildung 4.8: Skizzierte Darstellung der Kameraschiefstellung und des Kameralots. Die 
gelieferten Messwerte (z) der Tiefenbildkamera entsprechen nicht den tat- 
sächlichen Entfernungen (c). Über den Winkel & und z kann diese über eine 
trigonometrische Formel berechnet werden. 


Anhand der in Abbildung 4.8 skizzierten „tatsächlichen Entfernungen“ ist 
zu erkennen, dass diese von links nach rechts in Richtung Kameralot ab- 
nehmen und nach Erreichen der kürzesten Entfernung im Lot wieder zuneh- 
men. Es besteht folglich eine Abhängigkeit der Entfernungen vom jeweili- 
gen Bildpunkt der Kamera. Ziel ist es, die tatsächlichen Entfernungen aus 
den Messwerten zu rekonstruieren und eine parabelförmige Regression zu 
ermitteln. Die x-Koordinate des Scheitelpunktes der Parabel entspricht der 


Position des Kameralotfusspunktes. Folgend wird nur die Berechnung der 
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x-Koordinate betrachtet. Die Berechnung der y-Koordinate erfolgt äquiva- 
lent. 

Bei einer gegebenen Auflösung von 512 Bildpunkten können in der hori- 
zontalen 511 Bildpunktpaare gebildet werden, die ein Sichtfeld von 70,6° 
abdecken. Damit entspricht der Abstand zweier nebeneinander liegender 
Bildpunkte einem Winkel von DS 0,138°. 

Da es sich bei der gewählten Tiefenbildkamera um eine sphärische Kamera 
handelt, kann die tatsächliche Entfernung c gemäß Abbildung 4.8 über die 


trigonometrische Formel 


sin(@) = - (4.7) 


bestimmt werden. An einem beliebig gewählten Bildpunkt des Kamerasys- 
tems entspricht z dem von der Kamera wiedergegebenen Messwert, wäh- 
rend sich der Winkel & aus der x-Koordinate, ausgehend vom Bildmittel- 


punkt, zusammensetzt. 


a, = |(256,5 — x) -0, 138| (4.8) 


Der Bildmittelpunkt liegt bei den Koordinaten Pgm(256,5/212,5) (siehe 
Abbildung 4.8). 


horizontal 5880 -, vertikal 
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Abbildung 4.9: Auftrag aller Messwerte mit den dazugehörigen Polynomen 
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Nach der Umrechnung von 100 Messwerten, welche symmetrisch und line- 
ar um den Bildmittelpunkt angeordnet sind, ergeben sich die in Abbildung 
4.9 dargestellten Messwerte in x und y-Koordinaten. Aus der Regression 


haben sich folgende Polygone ergeben: 


fo) = 7350,44 — 11,67x+0,0216x° 


in horizontaler Richtung mit einem Bestimmtheitsmaß (R?)von0,976und 
fa = 6455,99 — 7,28y + 0,0193y?in vertikaler Richtung mit einem Be- 
stimmtheitsmaß (R7)von0, 984. 


Die Ableitung der beiden Polynome ergab fiir f œ) = 0 und fy) = 0 eine 


Lotfusspunktposition von 


Prot = (270, 188] 


woraus sich in x und y-Richtung die beiden Neigungen 


@x = 1,9° und ay = -3,4°. 


des Sensors berechnen lassen. 


4.1.4 Fehleranalyse der Messwerte 


Nach dem Ausgleich der Kameraschiefstellung folgt in diesem Kapitel die 
Analyse der Messwerte auf deren Genauigkeit und Stabilität. Rauschende 
Messwerte haben einen großen Einfluss auf die Leistungsparameter des Ge- 
samtsystems. Durch die Fehleranalyse der Messwerte kann ermittelt wer- 
den, wie groß die Abweichungen sind und wie häufig Abweichungen einer 
bestimmten Größe auftreten. 

Zu diesem Zweck wurden an verschiedenen Stellen im Messbereich Gebie- 


te festgelegt und die darin liegenden Abweichungen zur Bodenebene ana- 
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Abbildung 4.10: Visualisierte Darstellung des Höhenunterschieds zur Bodenebene gemittelt 
über 100 Bilder. Dargestellt sind zudem fünf Bereiche, in denen die Abwei- 
chungen von der Bodenebene genauer untersucht wurden. 


lysiert (siehe Abbildung 4.10). Ein repräsentatives Ergebnis wurde dadurch 
erzielt, dass in den fünf Bereichen jeweils 4000 Messwerte aufgezeichnet 
wurden. Berücksichtigt wurden die vom Kameralot nach außen hin zuneh- 
mende Anzahl an nicht erfolgreichen Messungen auf Grund des spiegeln- 
den Hallenbodens. Da eine ungleiche Anzahl an Messwerten pro Gebiet zu 
einer verfälschenden Gewichtung des Ergebnisses führen würde, wurden in 
jedem Gebiert über mehrere Einzelbilder hinweg die Abweichungen errech- 
net, bis jeweils 4000 erfolgreiche Messwerte aufgezeichnet werden konnten. 
Abhängig von der Anzahl der fehlenden Messwerte, mussten für die äu- 
Beren Bereiche mehr Einzelbilder ausgewertet werden als für die inneren. 
So wurden zum Beispiel für Bereich [a], in Abbildung 4.10 dargestellt, 87 
Bilder ausgewertet, während in Bereich [c] nur 10 Einzelbilder notwendig 
waren. Das Ergebnis der Untersuchung wird in Abbildung 4.11 wiederge- 
geben. Während Messfehler im Größenbereich von -420 mm bis +320 mm 
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vorkommen, liegen 90% der Abweichungen in einem Bereich zwischen - 
165 mm und +165 mm. 
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Abbildung 4.11: Dargestellt ist die Häufigkeitsverteilung der Abweichungen der Messwerte 
von der Bodenebene. 
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4.1.5 Entfernen der Bodenebene 


Mit dem Ziel alle Objekte möglichst schnell innerhalb des überwachten Be- 
reichs zu erkennen und zu untersuchen, muss die zu analysierende Daten- 
menge möglichst stark reduziert werden. Aus Abbildung 4.7 geht hervor, 
dass nicht nur die relevanten Messwerte der Objekte ausgewertet werden, 
sondern auch solche, die den Boden beschreiben, obwohl dieser für eine 
Objekterkennung irrelevant ist. Um die Datenmenge zu reduzieren wird im 
folgenden Kapitel eine Methode eingeführt, die es erlaubt ohne großen Auf- 


wand einen Großteil der irrelevanten Messwerte heraus zu filtern. 


t _—Kamerasystem 
=, (a) Relevanzebene 
lon erar 
Ly (b) 


Abbildung 4.12: Schematische Darstellung der Relevanzebene mit Zeit unterschiedliche 
hohen Objekten (a) und (b). 


Dies geschieht, indem alle Messwerte, die eine festgelegte Entfernung zur 
Kamera tiberschreiten, aus der Datenmenge entfernt werden. Diese festge- 
legte Entfernung sollte kleiner sein, als die Entfernung zum Boden, damit 
dieser herausgefiltert wird. Im Folgenden wird diese Entfernungsgrenze Re- 
levanzebene genannt (siehe Abbildung 4.12). Alle Objekte, die Entfernun- 
gen aufweisen, welche unterhalb der Relevanzebene liegen, werden heraus- 
gefiltert (siehe Abbildung 4.12 (b)), während die, welche darüber liegen 
weiterverarbeitet werden (siehe Abbildung 4.12 (a)). 
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Einerseits wurde versucht, die Grenze möglichst knapp über dem Boden 
anzusetzen, damit auch flache Objekte erkannt werden können. Anderer- 
seits geht aus der Analyse der Messwerte (siehe Abschnitt 4.1.4) hervor, 
dass die Relevanzhöhe häufiger von irrelevanten, rauschenden Messwer- 
ten überschritten wird, je näher diese an der Bodenentfernung liegt. Der 
Zusammenhang zwischen dem Abstand der Bodenentfernung und der Rele- 
vanzhöhe und dem Ergebnis des Filters, ist in Abbildung 4.11 am Beispiel 


dreier unterschiedlicher Abstände dargestellt. 


Abbildung 4.13: Dargestellt sind die restlichen Bildpunkte, nachdem alle jene entfernt wur- 
den, welche unterhalb der Relevanzhöhe lagen. Die Relevanzhöhe wurde 
von links beginnend auf 25 mm, 100 mm und 200 mm festgelegt. 


Während in der linken Darstellung der Anteil verrauschter Messwerte noch 
sehr hoch ist, nimmt er, mit abnehmender Relevanzhöhe kontinuierlich ab. 
Zu erkennen ist auch, dass in der rechten Darstellung nicht nur rauschen- 
de Messwerte deutlich reduziert wurden, sondern bereits Informationen und 
ganze Objekte verloren gehen, die für eine spätere Kollisionsvermeidung 
notwendig sind (siehe Abbildung 4.13 die eingekreisten Bereiche). Tests 
haben ergeben, dass bei einer Relevanzhöhe von 75 mm ein gutes Resul- 
tat erzielt wird, bei dem das Rauschen deutlich reduziert wird, aber dennoch 
keine Objekte verloren gehen, die für eine spätere Navigation eines Fahrzeu- 
ges nicht ignoriert werden können. Bei dieser Höhe werden gemäß Tabelle 
4.1 79,65% aller irrelevanten Messwerte entfernt. Bei 20,35% der Mess- 


werte handelt es sich um Rauschen. Weitere Zusammenhänge zwischen der 
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Relevanzhöhe und dem Restrauschen sind in der folgenden Tabelle darge- 
stellt: 


4.1.6 Analyse der Restrauschdichte 


Trotz der Einführung einer Relevanzhöhe kommt es auf Grund stark ver- 
rauschter Messwerte in 20,35% der Fälle zu einer fehlerhaften Überschrei- 
tung der Relevanzhöhe. Die Häufigkeit der Überschreitungen ist jedoch 
nicht gleichmäßig über den überwachten Bereich verteilt. Abhängig von den 
optischen Verhältnissen oder der Beschaffenheit des Untergrundes, kann es 
in einigen Bereichen gehäuft zu Fehlern kommen. Aus diesem Grund wurde 
eine weitere Fehleranalyse durchgeführt, um die Rauschdichte zu bestim- 
men. Die Rauschdichte gibt an, wie häufig ein Messwert im Durchschnitt 
die Relevanzhöhe überschreitet. Die Größe der Abweichung spielt in diesem 
Fall keine Rolle. Zur Bestimmung der Dichte wurde über 100 Einzelbilder 
hinweg jeder einzelne Bildpunkt überprüft und aufgezeichnet, wie häufig 
die Relevanzhöhe überschritten wurde. 

In Abbildung 4.14 wird eine Übersicht über die Häufigkeiten der Über- 
schreitungen der Relevanzhöhe jedes einzelnen Bildpunktes gezeigt. Zu er- 
kennen ist, dass die Häufigkeit der Überschreitungen nicht homogen über 


den Bildausschnitt verteilt sind. Während es in den farblich markierten Be- 


Tabelle 4.1: Anteil verrauschter Messwerte bei unterschiedlichen Relevanzhöhen. 


Relevanzhöhe Rauschen in % 


25 mm 38,64 
75mm 20,35 
100 mm 14,61 
200 mm 3,255 
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Abbildung 4.14: Farblich dargestellt sind die Anzahlen an Relevanzhöhenüberschreitungen 
über 100 Bilder hinweg. Weiße Bildpunkte signalisieren, dass die Relevanz- 
höhe im Laufe der Bilderreihe nicht überschritten wurde. 


reichen zu Überschreitungen kommt, werde die Relevanzhöhe in den wei- 
Ben Bereichen nicht überschritten. Es ist zu erkennen, dass der in Abbildung 
4.14 mit einem schwarzen Quadrat markierte Bereich zu den Gebieten mit 
einer hohen Anzahl an Überschreitungen gehört. Eine genaue Untersuchung 
hat ergeben, dass es im Durchschnitt bei jedem Bildpunkt alle 26 Bilder zu 
einer Überschreitung kommt. Das heißt, dass die Wahrscheinlichkeit eines 
fehlerhaften Überschreitens der Relevanzhöhe bei ~ 3,85% liegt. 


4.1.7 Rauschunterdrückung/Rauschstabilisierung 


Basierend auf den vorangegangen Untersuchungen zur Rauschdichte wird 
im folgendem Abschnitt eine eigens entwickelte Methode vorgestellt, mit 
der das restliche Rauschen zu einem Großteil herausgefiltert werden kann. 
Aus Abbildung 4.13 geht hervor, dass auch nach dem Neigungsausgleich 


und der Einführung der Referenzhöhe von 75 mm das Rauschen nicht voll- 


37 


4 Objekterkennung 


ständig entfernt wurde. Basierend auf der Idee der „Occupancy Map“ [30] 
S.221, wonach Messwerte, die häufiger an einem bestimmten Ort erschei- 
nen, höher gewichtet werden, werden auch bei der selbst entwickelten 
Rauschunterdrückung die Messwerte über einen bestimmten Zeitraum hin- 


weg beobachtet. 


Abbildung 4.15: Darstellung des Rauschens bei einer Relevanzhöhe von 75mm 


Der Grundgedanke des Filters basiert auf der Annahme, dass die Wahr- 
scheinlichkeit sehr gering ist, dass ein rauschender Bildpunkt mehrfach hin- 
tereinander die Relevanzhöhe überschreitet. Eine einfache Umsetzung wäre 
beispielsweise, dass ein Bildpunkt erst dann als relevanter Punkt akzeptiert 


wird, wenn er mindestens zweimal hintereinander erscheint. 


Bei genauer Betrachtung muss berücksichtigt werden, dass es zwei un- 
terschiedliche Gründe für die Entstehung von Rauschen gibt. Während in 
Abbildung 4.15 (a) das Rauschen durch Schwankungen der Messwerte in 
z-Richtung entsteht, wird es bei (b) durch ein Mangel an Messwerten her- 
vorgerufen. Ziel ist es einerseits das Rauschen zu unterdrücken (a) und 


andererseits relevante Messwerte zu erkennen und diese zu stabilisieren. 
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Mehrere Parameter spielen hierbei eine Rolle. Zum einen wird ein Bild- 
punkt dann berücksichtigt, wenn er mindestens n Mal hintereinander die 
Relevanzhöhe überschreitet. Diese Mindestanzahl n wird im Folgenden Er- 
scheinungsgrenze genannt. Zu berücksichtigen ist jedoch: Je höher die Er- 
scheinungsgrenze angesetzt wird, desto länger dauert es, bis der Messwert 
als relevanter Messwert akzeptiert wird. Bei sich bewegenden Objekten 
kann dieser Umstand zu Problemen führen. 

Zum anderen wird als Parameter die Steigungsrate eingeführt. Bis jetzt wur- 
de davon ausgegangen, dass ein Zähler um eins erhöht wird, sobald eine 
Messung positiv ausfällt. Denkbar ist jedoch auch eine Erhöhung des Zäh- 
lers um einen Wert größer eins. Je größer der Wert der Steigungsrate, desto 
schneller wird die Erscheinungsgrenze erreicht (siehe Abbildung 4.16). 
Das Pendant zur Steigungsrate ist die Senkungsrate welche beschreibt, um 
welchen Wert der Zähler reduziert wird, falls die Relevanzhöhe unterschrit- 
ten wird. Es hat sich herausgestellt, dass das Verhältnis zwischen Steigungs- 
rate und Senkungsrate einen großen Einfluss auf das Ergebnis der Eliminie- 
rung bzw. Stabilisierung hat. Aus diesem Grund wird folgend die Senkungs- 
rate unverändert bei eins liegen und nur die Steigungsrate variiert. 

Der letzte Parameter, der zur Beschreibung der Rauschbehandlung herange- 
zogen wird ist die Obergrenze. Sie beschreibt die Grenze, ab der der Zähler 
nicht mehr erhöht wird. Diese muss nicht zwingen der Erscheinungsgrenze 
entsprechen. Liegt die Obergrenze deutlich über der Erscheinungsgrenze 
und beträgt die Senkungsrate eins, muss die Relevanzhöhe mehrere Ma- 
le hintereinander unterschritten werden, bis der Bildpunkt irrelevant wird. 
Eine größere Differenz zwischen Erscheinungsgrenze und Obergrenze un- 
terstützt einerseits die Stabilisierung, führt andererseits aber auch zu einer 
Verzögerung bei der Erkennung von Objekten. 

In Abbildung 4.16 sind die Zusammenhänge der einzelnen Parameter sche- 


matisch dargestellt. Erscheint ein Messwert zweimal hintereinander, erreicht 
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Abbildung 4.16: Rauschunterdrückungsparameter 


der Zähler die Erscheinungsgrenze und wird relevant. Erscheint er ein drit- 
tes Mal, ist die Obergrenze erreicht. Verschwindet ein Objekt, bzw. wird die 
Relevanzhöhe in den nachfolgenden Messungen nicht überschritten, sinkt 
der Zähler wieder, unterschreitet nach sechs Messungen die Erscheinungs- 
grenze und wird irrelevant. Zusammengefasst kann gesagt werden, dass ein 
zu einem Objekt gehörender Messwert schnell sichtbar und relevant wird 
aber nur langsam wieder verschwindet. 

Nachdem die einzelnen Parameter erläutert wurden, wird folgend beschrie- 
ben, von welchen Faktoren die Parameter abhängig sind und wie sie fest- 
gelegt werden. Zwei Faktoren sind bei der Festlegung der Parameter aus- 
schlaggebend, die Rauschdichte (siehe Abschnitt 4.1.6) und die Latenz (sie- 
he Abschnitt 4.1.8). Während die Rauschdichte beschreibt, wie häufig ein 
Messwert an einer bestimmten Stelle die Relevanzhöhe überschreitet, be- 
schreibt die Latenz die Zeit die vergeht, bis ein relevanter Punkt tatsäch- 
lich weiterverarbeitet wird. Aus Abschnitt 4.1.6 geht hervor, dass in einem 
ungünstigen Fall eine durch Rauschen hervorgerufene Relevanzhöhenüber- 
schreitung alle 26 Bilder vorkommen kann. Hieraus lässt sich ableiten, dass 
die Steigungsrate nicht größer oder gleich 26 sein darf, soll das Rauschen 
unterdrückt werden. Für eine Stabilisierung möglichst vieler Messwerte, 
sollte das Verhältnis jedoch möglichst nahe an der Rauschdichte liegen, da 


relevante Überschreitungen möglichst lange bestehen sollen. 
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Abhängig von der Rauschdichte ist auch die Differenz zwischen der Ober- 
grenze und der Erscheinungsgrenze. Damit ein Messwert dauerhaft relevant 
bleibt, muss die Differenz größer sein, als das Verhältnis von Steigungsrate 
zu Senkungsrate. Die Erscheinungsgrenze in Kombination mit der Stei- 
gungsrate beeinflussen wiederum die Latenz. Der exakte Einfluss der Para- 


meter auf die Latenz wird im folgenden Kapitel erläutert. 


Zusammengefasst kann gesagt werden, dass mittels eines heuristischen Ver- 
fahrens eine situationsabhängige Rauschunterdrückung bzw. Messwertsta- 


bilisierung umgesetzt werden konnte. Die relevanten Parameter sind: 


die Steigungsrate, 
e die Senkungsrate, 
e die Erscheinungsgrenze und 


e die Obergrenze. 


Eingestellt werden sollte die Rauschverarbeitung nach folgenden heuristi- 


schen Regeln: 


e Die Steigungsrate darf nicht größer oder gleich der Rauschdichte sein, 
da sonst rauschende Pixel zu Objekten gezählt werden. 

e Die Steigungsrate sollte so groß wie möglich gewählt werden, um 
schlecht sichtbare Objekte zu stabilisieren. 

e Die Differenz zwischen der Erscheinungsgrenze und der Obergrenze 
sollte mindestens so groß sein, wie die Steigungsrate. 

e Die Erscheinungsgrenze in Kombination mit der Steigungsrate sollten 
so gewählt werden, dass ein neues Objekt möglichst schnell sichtbar 


wird. 
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4.1.8 Latenz 


Die Gesamtlatenz beschreibt die Zeit, die vergeht, bis ein Objekt vom Sys- 
tem zum ersten Mal erkannt wird. Sie setzt sich aus den folgenden einzelnen 


Latenzen zusammen: 


e Bildrate, 

e Datenverarbeitung Sensor, 
e Rauschkorrektur, 

e Datenübertragung, 


e Datenverarbeitung FTF. 


Die Latenzen werden in zwei unterschiedliche Kategorien unterteilt. Im ers- 
ten Fall sind die Latenzen voneinander unabhängig und können empirisch 
bestimmt werden. Hier ordnen sich die Bildrate, die Datenverarbeitung und 
die Datenübertragung ein. Im zweiten Fall gibt es eine Abhängigkeit zwi- 
schen den einzelnen Latenzen. So ist die Latenz der Rauschunterdrückung 
von der Bildrate und der Geschwindigkeit des untersuchten Objekts abhän- 
gig. 

Die Gesamtlatenz hat einen direkten Einfluss auf die Positionsbestimmung 
eines sich bewegenden Objektes und darf nicht beliebig hoch sein. Je schnel- 
ler sich das Objekt bewegt, desto größer wird der Positionierfehler bei 
gleichbleibender Latenz. Bei gegebener Positioniertoleranz und Latenz muss 
dementsprechend die Geschwindigkeit angepasst werden. Damit die maxi- 
mal mögliche Gesamtlatenz bestimmt werden kann, werden zuvor einige 
Annahmen getroffen. 

Zu Beginn wurde der maximale Positionierfehler definiert, der auftreten 
darf. Dieser wird bei der Navigation berücksichtigt, indem ein Abstand zu 
anderen Objekten von mindestens der zweifachen Größe des Positionierfeh- 
ler eingehalten werden muss, um eine Kollision zu vermeiden. Schätzungen, 
die auf vorab durchgeführten Auswertungen basieren, ergeben, dass von ei- 


ner Latenz bei der Rauschunterdrückung von 0,2 Sekunden und einer Ge- 
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samtlatenz von 0,45 Sekunden ausgegangen werden sollte (siehe Abschnitt 
73). 

Gemäß der Formel v = s/t ergibt sich bei einer Geschwindigkeit von 0,5 m/s 
ein Positionierfehler von 0,225 m. 

Die Latenz bzw. der Positionierfehler durch die Rauschkorrektur kann auf 


zwei unterschiedliche Einflüsse zurückgeführt werden: 


e Latenz beim Erscheinen eines Objektes, 


e Latenz bis zum Verschwinden eines Objektes. 


f tatsachlicher Mittelpunkt 
inv ß 
sta l 
1 fey) Bewegungsrichtung 
I al fayn 


\ i è i| — dynamisch 


| i b | ——> statisch 
I | > inventarisiert 


— 
1 


tatsachliche Fahrzeugposition 


Abbildung 4.17: Darstellung der Positionierfehler im Vergleich zur tatsächlichen Position: 
(von oben nach unten) tatsächliche Position, Objekt erscheint und ver- 
schwindet ein Bild später, Objekt erscheint ein Bild später und verschwindet 
5 Bilder später, Objekt erscheint ein Bild später und verschwindet erst sehr 
spät. 


Der entstehende Fehler, hervorgerufen durch ein verspätetes Erscheinen 
oder Verschwinden eines sich bewegenden Objektes ist in Abbildung 4.17 
dargestellt. Abhängig von der Steigungsrate erscheint das Objekt erst nach 
einer bestimmten Anzahl an Bildern. Dieses späte Erscheinen führt dazu, 
dass die berechnete Mittelpunktposition der tatsächlichen Position hinter- 


her „hinkt“. Der selbe Effekt tritt auch beim Verschwinden eines Objektes 
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auf. Abhängig davon wie hoch die Obergrenze und die Senkungsrate ge- 
wählt werden, dauert es einige Bilder, bis das Objekt wieder verschwindet, 
obwohl das tatsächliche Objekt schon verschwunden ist. Die Auswirkun- 
gen dieser Verzögerungen auf den Positionierfehler sind in Abbildung 4.17 
für die drei Zustände dynamisch fayn, fsın und fin, dargestellt. Es wird im- 
mer davon ausgegangen was passiert, bewegt sich ein dynamisches Objekt, 
oder setzt sich ein statisches oder inventarisierten Objekt in Bewegung. Bei 
einem inventarisierten Objekt kann der Fehler sehr groß werden, da das 


Verschwinden nur sehr langsam von statten geht. 


4.1.9 Zusammenfassung Kamerainitialisierung 


Das Ziel der Kamerainitialisierung war es, äußere Einflüsse zu kompensie- 
ren und die von der Tiefenbildkamera gelieferten Messwerte zu bereinigen. 
Über die Bereinigung hinaus konnten Bereiche, die auf Grund einer großen 
Anzahl an Fehlmessungen leiden, hervorgehoben werden. 

Abbildung 4.18 zeigt eine Gegenüberstellung der Ursprungsdaten in Form 
einer Momentaufnahme (links) und der über mehrere Bilder hinweg überar- 
beiteten Daten (rechts). Zur Bereinigung beigetragen hat der Neigungsaus- 
gleich, das Entfernen der Bodenebene und die Rauschunterdrückung bzw. 
Rauschstabilisierung. Obwohl die einzelnen Objekte nach der Bearbeitung 
einerseits deutlich besser zu erkennen sind und das Rauschen stark reduziert 
werden konnte, treten immer weiterhin fehlerhafte Messungen auf. Diese 


werden im folgenden Kapitel mit Hilfe der Segmentierung neutralisiert. 


4.2 Segmentierung und Transformation 


Die Segmentierung ist ein Teilgebiet der digitalen Bildverarbeitung und 
dient der Erzeugung zusammenhängender Bereiche durch die Zusammen- 
fassung benachbarter Bildpunkte. Ziel ist es, möglichst schnell zusammen- 


hängende Bereiche mit einer bestimmten Mindestgröße zu erkennen. Diese 
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me 


Abbildung 4.18: Gegenüberstellung der ursprünglichen Kameradaten eines Bildes links und 
der über mehrere Bilder hinweg gemittelten Daten rechts. 


. FS 


werden in Abbildung 4.19 als grüne Bereiche dargestellt. Bereiche, die die 
Mindestgröße nicht erreichen, werden im weiteren Prozess nicht weiter be- 
rücksichtigt. Fehlerhafte Messwerte können auf diese Weise herausgefiltert 
werden, so dass nur noch die relevanten Daten übrig bleiben. Abhängig vom 
Abstand der Kamera zum Boden und von der Auflösung der Kamera, kann 
die minimale Größe von Objekten, die noch erkannt werden, stark variie- 
ren. 

Mit Hilfe der Transformation werden die einzelnen Bildpunkte vom ur- 
sprünglichen Pixel-Koordinatensystem in ein metrisches Koordinatensys- 


tem umgerechnet. 


4.2.1 Segmentierung 


Da gängige Segmentierungsalgorithmen auf die Auswertung von Bildern 
ausgelegt sind, können einige Ansätze übernommen werden. Nach Bhosle 
und Pawar kann der Segmentierungsprozess in sieben Stufen unterteilt wer- 
den [3]: 
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Abbildung 4.19: Ziel der Segmentierung ist es, alle relevanten Objekte (grün) zu erkennen, 
und Rauschen (grau) herauszufiltern 


. Auslesen des Bildes aus der Datenbank, 
. Farbbild in Graustufenbild umwandeln, 
. Filter auf das Bild anwenden, 

. Bereiche extrahieren, 

. Segmentiertes Bild darstellen, 


. Schritt drei wiederholen, falls Segmentierung missglückt, 


na vv fF WN 


. In Datenbank abspeichern. 


Im Falle der hier durchgeführten Datenverarbeitung, müssen nicht alle Stu- 
fen angewendet werden. So ist das Auslesen des Bildes aus der Datenbank 
hinfällig (Punkt 1), da das Bild bzw. die Entfernungsmatrix in Echtzeit, oh- 
ne Zwischenspeicherung auf der Festplatte, direkt verarbeitet wird. Auch 
nach der Segmentierung (Punkt 7) werden die Ergebnisse nicht gespeichert, 
sondern direkt weiterverarbeitet und anschließend verworfen. Da es sich bei 
dem Tiefenbild nicht um ein Farbbild handelt, ist auch eine Umwandlung in 
ein Graustufenbild hinfällig. Auch wird das segmentierte Bild nur zu Test- 
zwecken, jedoch nicht im normalen Betrieb dargestellt. Aus diesen Gründen 


wurden nur die Stufen 3 und 4 behandelt. 
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Das Filtern der Daten wurde bereits in den voran gegangenen Kapiteln be- 
schrieben. Unter anderen finden mehrere Filter Anwendung, wie zum Bei- 
spiel die Rauschunterdrückung oder das Entfernen des Boden mittels der 
Thresholding-Methode [27]. 

Das Hauptaugenmerk liegt auf der Extraktion der einzelnen Bereiche. Da 
jeder einzelne Bildpunkt untersucht und zugewiesen werden muss, ist die 
Extraktion sehr rechenaufwändig, weshalb ein Kriterium ist die Extraktion 


möglichst einfach zu gestalten. 


4.2.2 Eigener Extraktionsansatz 


Bei der Entwicklung des Extraktionsansatzes müssen zwei Randbedingun- 


gen erfüllt werden: 


e Hohe Geschwindigkeit - wenig Zugriffe auf einzelne Bildpunkte und 


e Leerstellen müssen mit einbezogen werden. 


Bei der Extraktion wird bei jedem einzelnen Bildpunkt überprüft, welchem 
Objekt er zugeordnet werden kann. Eine solche Zuordnung kann auf un- 
terschiedliche Weise umgesetzt werden. So werden bei dem so genannten 
„One-Pass-Filter“ von Rosenfeld die einzelnen Bildpunkte bei nur einem 
Durchgang zeilenweise in einzelne, kleine, separate Gruppen eingeteilt, die 
im Anschluss zu ganzen Segmenten zusammengesetzt werden [26]. Ein 
Nachteil ist jedoch, dass Leerstellen, d.h. Bereiche innerhalb eines Objektes 
ohne Messwerte, bei diesem Ansatz nicht mit integriert werden. Dies kann 
zu einem Versatz des Flächenschwerpunktes führen (siehe Abbildung 4.20). 
Eine Integration der Leerstellen ist jedoch wichtig, da ohne sie Fehler bei 
der Bestimmung der Position entstehen können. Fehlmessungen können auf 
Grund von starkem Rauschen oder stark reflektierenden Oberflächen auftre- 
ten. Der in Abbildung 4.20 dargestellte Versatz des Mittelpunktes, ist auf 
eine auf dem Fahrzeug montierte, reflektierende Oberfläche zurück zu füh- 


ren. Das weiße Kreuz beschreibt die Position des Mittelpunktes wenn das 
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Abbildung 4.20: Das rote Kreuz stellt den Flächenschwerpunkt des Objektes dar, wenn dieses 
nicht aufgefüllt ist, d.h. wenn die hellgrau hinterlegten Bereiche nicht in die 
Schwerpunktberechnung eingeflossen sind. Werden die hellgrauen Bereiche 
berücksichtigt, verschiebt sich der Flächenschwerpunkt, dargestellt durch 
das weiße Kreuz. 


Fahrzeug keine Leerstellen aufweist, während das rote Kreuz die Positi- 
on markiert, die ermittelt wird, wenn Leerstellen nicht aufgefüllt werden. 
Gemäß der Annahme, dass Fahrzeuge keine Löcher aufweisen, wird davon 
ausgegangen, dass es sich bei den vermeintlichen Leerstellen innerhalb ei- 
nes Objektes um Fehlmessungen handelt. 

Mit dem Ziel Leerstellen zu integrieren und den Berechnungsaufwand mög- 
lichst gering zu halten, wurde ein neuartiger Segmentierungsalgorithmus 


entwickelt und implementiert. Die Segmentierung erfolgt in fünf Schritten: 


e Finden eines Objektes 

e Bestimmung der Randpunkte des Objektes 
e Charakterisierung der Randpunkte 

e Auffüllen des Objektes 

e Überprüfen des Objektes 


Gefunden wird ein Objekt, indem Zeile für Zeile von links nach rechts und 
von oben nach unten nach relevanten Bildpunkten gesucht wird (siehe Ab- 
bildung 4.21 (1a)). Der erste gefundene Bildpunkt ist in Abbildung 4.21 (1) 
als blauer Punkt markiert. Ist ein Objekt gefunden, wird willkürlich eine 
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Identifikationsnummer festgelegt. Bei der nachfolgenden Randpunktsuche 
(siehe Abbildung 4.21 (2)) wird die ID auf jeden weiteren Punkt übertragen, 
bis das Objekt einmal komplett umrundet wurde. Am Startpunkt angekom- 
men, wird die Extraktion des gefundenen Objektes unterbrochen und die 
Datenmatrix, gemäß Abbildung 4.21 (3b), zeilenweise weiter nach Objek- 
ten durchsucht. Trifft der Algorithmus bei seiner Suche auf einen Randpunkt 
dem schon eine ID zugewiesen wurde, wird diese auf jeden weiteren Bild- 
punkt in Suchrichtung übertragen, siehe Abbildung 4.21 (4). Hierdurch wird 
die Zeile so lange ausgefüllt, bis ein weitere Randpunkt den Prozess beendet 
und das Auffüllen unterbrochen wird. Die zeilenweise Suche nach Objekten 


wird fortgesetzt. 


Abbildung 4.21: Erklärung des Segmentierungsansatzes. Als erstes wird das Objekt gefunden, 
anschließend werden die Randpunkte gesucht und die Art der Randpunkte 
bestimmet. Abschließend wird das Objekt aufgefüllt. 


Neben der Identität besitzt jeder Randpunkt eine weitere Eigenschaft, die für 
das spätere Auffüllen wichtig ist. Dabei handelt es sich um die Anzahl, wie 
häufig ein Punkt bei einer Suchumrundung durchlaufen wurde. Im Idealfall 
folgt ein Randpunkt dem anderen, bis das Objekt einmal komplett umrun- 
det wurde und man wieder am Startpunkt angekommen ist. Jeder Randpunkt 
würde nur einmal gefunden werden. Dennoch kann die Suche in Sackgassen 


führen, so dass ein Randpunkt auf dem Rückweg ein zweites Mal gefunden 
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wird (siehe Abbildung 4.21 (3) im vergrößerten Bereich). Ein Auffüllen des 
Objektes gemäß Abbildung 4.21 (4) führt an einer solchen Stelle dazu, dass 
Bereiche aufgefüllt würden, die außerhalb des Objektes liegen. Dieser Ef- 
fekt tritt auf Grund der zeilenweisen Suche ausschließlich bei Sackgassen in 
vertikaler Richtung auf, weshalb diese gesondert betrachtet werden müssen. 
Der Ablauf sieht dabei wie folgt aus: Zu Beginn ist der Zähler auf Null 
gesetzt und wird um „eins“ erhöht, sobald ein Randpunkt in vertikaler Rich- 
tung einmal durchlaufen wird. Dies geschieht, wenn er das erste Mal erkannt 
wurde. Im Falle eines zweifachen Durchlaufens wird der Zähler wiederum 
um „eins“ erhöht und erhält den Wert „zwei“. 

Stößt der Algorithmus anschließend bei der Objektsuche auf einen bereits 
zugewiesenen Randpunkt mit dem Zähler „eins“, wird die Matrix in hori- 
zontaler Richtung aufgefüllt, bis ein weiterer Randpunkt mit einer „eins“ 
gefunden wird. Trifft er jedoch auf einen Punkt mit dem Zähler „zwei“ 
findet kein Auffüllen statt und die Suche nach weiteren Objekten wird in 
horizontaler Richtung fortgesetzt. Beim Auffüllen selbst wird jeder Positi- 
on, unabhängig vom Messwert, die Identität des anfänglichen Randpunktes 


zugewiesen und somit dem Bereich zugeordnet. 


Sind alle Objekte gefunden, werden diese ein weiteres Mal gefiltert indem 
sie auf ihre Größe hin untersucht wird. Damit ein gefundenes Objekt im 
folgenden Prozess mitgeführt wird, muss es eine Mindestgröße aufweisen. 
Durch die Festlegung einer Minimalgröße, können Objekte, die auf rau- 
schenden Messwerten basieren, ausgeschlossen werden. In Abbildung 4.22 
ist ein Vergleich zwischen den Objekten vor der Segmentierung und nach 
der Segmentierung dargestellt. Es ist zu erkennen, dass das Rauschen voll- 


ständig entfernt und Leerstellen innerhalb der Objekte aufgefüllt wurden. 
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Abbildung 4.22: Vergleich der Bildpunkte und der Objekte vor- (links) und nach (rechts) der 
Segmentierung 


4.2.3 Objektspezifische Rauschstabilisierung 


Die objektspezifische Rauschstabilisierung basiert auf der in Abschnitt 4.1.7 
vorgestellten Rauschunterdrückung und stellt eine Weiterentwicklung dar. 
Ziel ist es mit Hilfe objektspezifischer Parameter einzelne Objekte noch bes- 
ser hervor zu heben, von deren Status. 

Insgesamt werden die Objekte in drei unterschiedliche Stadien unterteilt 
(siehe Abschnitt 5.2). Diese sind abhängig von der Geschwindigkeit, mit 
der sich ein Objekt bewegt oder in Zukunft bewegen wird. Je nach Status 
ändern sich die Parameter für die Rauschunterdrückung bzw. Rauschstabi- 


lisierung: 


e dynamisch, 
e statisch, 


e inventarisiert. 


„Dynamisch“ beschreibt alle Objekte bei denen eine Bewegung ermittelt 
wurde. Wichtig ist, die durch die Bewegung hervorgerufene Latenz und so- 
mit den Positionsfehler (siehe Abschnitt 4.1.8) gering zu halten. 

Der Status „statisch“ wird allen Objekten zugewiesen, die sich aktuell nicht 
bewegen, bei denen aber damit gerechnet werden muss, dass sie sich je- 


derzeit wieder in Bewegung setzen. Bei einem statischen Objekt spielt die 
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Bewegungslatenz keine Rolle. Trotzdem darf sie nicht beliebig groß sein um 
eine Bewegung rechtzeitig zu detektieren. 

„Inventarisierte‘“ Objekte wurden extern von einer Person als solche dekla- 
riert und nicht automatisch. Es wird davon ausgegangen, dass sich inventa- 
risierte Objekte auch über einen längeren Zeitraum nicht bewegen werden. 
Darüber hinaus können sie auch nur durch eine Person wieder deinventa- 
risiert werden. Solange ein Objekt als Inventar deklariert ist, bleibt es an 
derselben Stelle verankert und behält auf Dauer seine Form. 

Die einzelnen Parameter werden abhängig von der Geschwindigkeit des Ob- 
jektes und der daraus resultierenden Latenz in Abschnitt 4.1.7 festgelegt. 
Die Position bzw. die Form eines Objektes, welches sich bewegt, sollte mög- 
lichst aktuell sein, um Kollisionen mit anderen Objekten zu vermeiden. Aus 
diesem Grund sollte die Erscheinungsgrenze bei neuem Erscheinen, als auch 


beim Verschwinden möglichst schnell über- bzw. unterschritten werden. 


Tabelle 4.2: Gewichtungstabelle der Globalen Lokalisierung. 


Positionsfehler 


Steigungsrate Senkungsrate Relevanzgrenze Obergrenze bei 1 m/s 
dynamisch 1 1 2 ki 8,67 cm 
statisch 5 1 10 15 15,17 cm 
statisch 5 1 50 100 


Statische Objekte bewegen sich aktuell nicht, können aber zu jeder Zeit in 
den dynamischen Status übergehen. Solange sich das Objekt nicht bewegt, 
kann die Aktualisierung vernachlässigt und die Rauschstabilisierung erhöht 
werden. Trotzdem muss immer damit gerechnet werden, dass sich das Ob- 
jekt in Bewegung setzt. Ein Zusammenstoß mit einem anderen Objekt auf 
Grund mangelnder Informationen wird vermieden, indem die Erscheinungs- 
grenze genau so schnell erreicht wird, wie im dynamischen Zustand. Eine 
höhere Rauschstabilität wird dadurch erreicht, dass die Abklingzeit deutlich 
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erhöht angesetzt wird. Setzt sich das Objekt wieder in Gang, wird der Status 
automatisch auf „dynamisch“ gesetzt. 

Von einer Person inventarisierte Objekte ändern ihre Position nicht, so lange 
sie nicht deinventarisiert wurden. Die Stabilisierung kann deshalb so hoch 
wie möglich eingestellt werden. Bei einer maximalen Restrauschdichte von 
26 (siehe Abschnitt 4.1.6) entspricht dies einer Steigungsrate von 25 bei 
einer Senkungsrate von eins. Die Differenz zwischen Obergrenze und Er- 
scheinungsgrenze kann beliebig hoch gewählt werden. In Tabelle 4.2 sind 


die einzelnen Parameter der jeweiligen Kategorien zusammengefasst. 


In Abbildung 4.23 ist ein Vergleich dargestellt. Der obere Teil zeigt das Er- 
scheinungsbild einiger Objekte vor der Rauschunterdrückung bzw. Rausch- 
stabilisierung, während der untere Teil dieselben Objekte danach zeigt. Zu 


erkennen ist, dass ein zusätzliches Objekt vorhanden ist, welches zuvor nicht 


dynamisch 
> inventarisiert 
& statisch wer 


Abbildung 4.23: Vergleich zweier Ergebnisse, basierend auf der allgemeinen Rauschun- 
terdrückung (oben), mit gleichen Parametern und der objektspezifischen 
Rauschunterdrückung (unten). 
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zu erkennen war. Von links nach rechts wurden die ersten vier Objekte als 
„dynamisch“ definiert, das mittlere als „statisch“ und das rechte als ,,inven- 
tarisiert“. Es ist zu erkennen, dass nicht nur ein weiteres Objekt sichtbar 
geworden ist, sondern dass das inventarisierte Objekt an Größe zugenom- 
men hat und die Konturen deutlicher zu erkennen sind. Mit Hilfe der Me- 
thode der Rauschunterdrückung konnte also viel zur Stabilisierung und zur 


Verdeutlichung der Objekte beigetragen werden. 


4.2.4 Transformation in Draufsicht 


Die detektierten Objekte unterliegen einer perspektivischen Verzerrung, so 
dass die Position der dargestellten Bildpunkte nicht den tatsächlichen Posi- 
tionen entsprechen. Die Darstellung ist von der Entfernung zum Kameralot 
und der Höhe des jeweiligen Bildpunktes abhängig. Die Position der einzel- 
nen Punkte kann mit Hilfe einer Transformation in eine Draufsicht korrigiert 


und die Schatten der Objekte eliminiert. 


Die geometrischen Zusammenhänge zwischen der Höhe, der Entfernung 
der Bildpunkte zum Lotfusspunkt der Kamera und der Kameraneigung sind 
in Abbildung 4.24 schematisch dargestellt. Ziel ist es, in Abhängigkeit die- 
ser drei Größen, die projizierte Position x in die tatsächliche Position Xneu 


zu transformieren. 


Es gilt: 


512 


Xneu = X (@—-B)-An, wobei Xn = 70.6 


ist. (4.9) 


Der Winkel œ gibt den Winkel zwischen Kameralot und projizierter Posi- 
tion wieder, während ß den Winkel zwischen Kameralot und tatsächlicher 
Position beschreibt. Der Winkel œ lässt sich Hilfe der x-Koordinate berech- 


nen. Jede Koordinate eines Bildpunktes des Tiefenbildes kann mit Hilfe ei- 
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Abbildung 4.24: Schematische Darstellung der für die Transformation notwendigen Größen. 


nes Winkels beschrieben werden. Bei einer horizontalen Auflösung von 512 
Bildpunkten und einem horizontalen Sichtfeld von 70,6 ° entspricht 1 ° ei- 


nem Xp von ungefähr 7,25 Bildpunkten. Daraus ergibt sich dass 


G= > (F -) ist. (4.10) 


Xa 2 
Der Winkel B errechnet sich aus as, ges und dem Winkel y, wobei Ages die 
mittlere Entfernung zwischen der Tiefenbildkamera und dem Hallenboden 
in Metern und y die Kameraneigung (siehe Abschnitt 4.1.2) in horizontaler 


Richtung wiedergibt: 


B = tan =) -y mit m=-aı (4.11) 


ges 
Hier ist ag als Entfernung zwischen dem projizierten Bildpunkt und dem 


Lotfusspunkt und a; als Entfernung zwischen der tatsächlichen Position des 
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Bildpunktes und dem Lotfusspunkt jeweils in Meter. ag und a; lassen sich 


wie folgt berechnen: 


ao = Nges-tan(y+ a) und (4.12) 


a, =h-tan(a+y). (4.13) 


Die Hohe des Objektes wird durch h beschrieben und ist die Differenz zwi- 
schen dem aktuellen Entfernungsmesswert und Ages. 

Nachdem alle Positionen in der horizontalen Richtung korrigiert wurden, 
wird die äquivalente Vorgehensweise in der vertikalen Richtung durchge- 
führt. Hierfür muss die vertikale Auflösung bei der verwendeten Kamera 
auf 424 Bildpunkte und das Sichtfeld auf 60 ° angepasst werden. 

In Abbildung 4.25 sind sowohl die ursprünglichen Bildpunkte in grau, als 
auch die transformierten Bildpunkte in rot dargestellt. Das hellgraue Kreuz 
im Zentrum markiert den Bildmittelpunkt während das dunkelgraue Kreuz 


für den Lotfusspunkt der Kamera steht. 


4.2.5 Zusammenfassung Segmentierung und 
Transformation 


In Abschnitt 4.2 wurde beschrieben, wie mit Hilfe eines eigens entwickel- 
ten Extraktionsansatzes die einzelnen Bildpunkte zu zusammenhängenden 
Objekten verbunden werden. Des weiteren wurde die in Abschnitt 4.1.7 vor- 
gestellte Rauschunterdrückung bzw. Rauschstabilisierung erweitert und an 
unterschiedliche Zustände angepasst. Abschließend konnte eine Methode 
zur Transformation der projizierten Bildpunkte in eine Draufsicht vorge- 


stellt werden. 
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inci, 


+ Lotfusspunkt 


Bildmittelpunkt 


Abbildung 4.25: Darstellung der von der Kamera gelieferten (grau) und der in die Draufsicht 
transformierten Punkte (rot). Der Bildmittelpunkt ist in Form eines hell- 
grauen Kreuzes und der Lotfusspunkt in Form eines dunkelgrauen Kreuzes 
dargestellt. 
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Die Positionsbestimmung eines fahrerlosen Transportsystems mit Hilfe der 
kommunikationsgestützten Lokalisierung erfolgt über die Selbsterkennung 
anhand der externen Sensordaten und der daraus abgeleiteten Eigenschaf- 
ten. Diese Eigenschaften aller Objekte werden mit Hilfe eines probabilis- 
tischen Ansatzes erhoben, ausgewertet und gewichtet. Zweck des Kapitels 
„Objekteigenschaften“ ist es, diese Eigenschaften anhand der in Kapitel 4 
gefilterten und überarbeiteten Messwerte zu bestimmen. Folgend sind alle 
Eigenschaften aufgeführt, die vom Kamerasystem ermittelt und publiziert 


werden: 


ObjektID, 
Mittelpunkt / Position, 
Status, 


allgemeine Objektgeschwindigkeit, 


allgemeine Objektorientierung, 


maximale Höhe, 
durchschnittliche Höhe, 


minimale Höhe und 


Objektumriss / Form. 


Neben den Eigenschaften des Kamerasystems gibt es weitere, die auf dem 
Fahrzeug selbst ermittelt werden. Als Basis dient einerseits die Form des 
Fahrzeuges und andererseits die Mittelpunktposition. Diese werden auf den 


Fahrzeugen weiter analysiert und um die Eigenschaften 
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e Umfang, 
e Fläche, 
e fahrzeugspezifische Geschwindigkeit und 


e fahrzeugspezifische Orientierung, 


erweitert. Zwecks einer besseren Unterscheidung wird zwischen allgemei- 


nen, kinematischen und geometrischen Eigenschaften unterschieden. 


5.1 Allgemein 


Unter die Kategorie „allgemeine Eigenschaften“ fällt die ObjektID und der 
Status. 


ObjektID 


Die ObjektID ist eine eindeutige Identifikationsnummer, die Objekten vom 
Kamerasystem zugewiesen wird. Sie ist fortlaufend und wird an neu erschie- 
nene Objekte vergeben. Objekte, die bereits eine ID zugewiesen bekommen 
haben, behalten diese. Wird jedoch ein Objekt verdeckt, bzw. ist fiir das 
Kamerasysteme die Objektkontinuität nicht mehr gegeben, wird ihm bei er- 


neutem Erscheinen eine neue ID zugewiesen. 


Status 


Der Status beschreibt den Zustand eines Objektes und ist in die drei Zu- 
stände „statisch“, „dynamisch“ und „inventarisiert“ unterteilt. Während die 
Zustände „statisch“ und „dynamisch“ von der Geschwindigkeit (siehe Ab- 
schnitt 5.2) des Objektes abhängig sind, wird der Status „inventarisiert‘ ma- 
nuell festgelegt. Die Inventarisierung kann nur von einem Menschen vorge- 
nommen werden. Ist ein Objekt inventarisiert, ist es an den Status gebunden 


und kann nur von einer Person wieder deinventarisiert werden. 
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5.2 Trajektorie 


Eigenschaften, die von der Position und der Bewegung eines Objektes ab- 


hängig sind, fallen in den Bereich Trajektorie. 


Objektposition (Mittelpunkt) 


Als Maß für die Position eines Objektes wurde der Flächenschwerpunkt, 
bzw. der Mittelpunkt gewählt. Die beiden Mittelpunktkoordinaten (xm,ym) 
ergeben sich aus dem arithmetischen Mittel aller relevanten x(bi)_ bzw. 
y(i) -Koordinaten der Bildpunkte eines Objektes. Die beiden Mittelpunkt- 
koordinaten lassen sich wie folgt beschreiben: 
P Obj n _ (Obj 
ies ae i yu = aes 2 (5.1) 
n n 

In Abbildung 5.1 sind zwei Objekte dargestellt. Auf der linken Seite ist das 
Versuchsfahrzeug zu erkennen, während auf der rechten Seite eine aufrecht 
stehende Europoolpalette dargestellt ist. Während bei dem Fahrzeug die Po- 
sition des Mittelpunktes, hier blau dargestellt, an der korrekten Stelle zu sein 
scheint, ist bei der Palette zu erkennen, dass es sich bei dessen Mittelpunkt, 
auf Grund der perspektivischen Verzerrung, mit großer Wahrscheinlichkeit 
nicht um den tatsächlichen Mittelpunkt handelt. 
Damit die Plausibilität der Mittelpunktposition eingeschätzt werden kann, 
wurde auf dieselbe Weise auch der Mittelpunkt des in die Draufsicht trans- 
formierten Objektes bestimmt. Der Vergleich beider Mittelpunkte erlaubt 


eine Einschätzung von der Güte der Mittelpunktschätzung. 


Mittelpunktgüte 


Die Mittelpunktgüte ist ein Maß für die Genauigkeit, die eine Mittelpunkt- 
koordinate aufweisen kann. Betrachtet man den angegebenen Mittelpunkt 


(hellblau) des transformierten Versuchsfahrzeuges in Abbildung 5.2, sieht 
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Abbildung 5.1: Darstellung der Mittelpunkte (blau) des FTF und der perspektivisch verzerr- 
ten, aufrecht stehenden Palette. 


man, dass dieser mit großer Wahrscheinlichkeit der tatsächlichen Positi- 
on entspricht, vorausgesetzt die Oberflache des Fahrzeuges ist eben und es 
kommt zu keinen Abschattungen. Dennoch kann es sein, dass sich Teile des 
Fahrzeuges in dessen Schatten verbergen, so dass sie auf Grund der Ka- 
meraperspektive nicht gesehen werden können. Die projizierte Darstellung 
korrigiert diese Fehlermöglichkeit. Es kann mit großer Wahrscheinlichkeit 
davon ausgegangen werden, dass der tatsächliche Mittelpunkt zwischen dem 
transformierten und dem projizierten Mittelpunkt liegt. Dieser Bereich wird 
fortan Mittelpunktbereich genannt. 


u 


Abbildung 5.2: Darstellung der Mittelpunkte auf Basis der transformierten Draufsicht (hell- 
blau) und auf Basis der projizierten Darstellung (blau) des FTF und der auf- 
recht stehenden Palette. 


Trotzdem kann es passieren, dass sich der tatsächliche Mittelpunkt au- 


ßerhalb des Mittelpunktbereiches befindet. Unter extremen geometrischen 


Randbedingungen, wie beispielsweise bei einer extremen Form der Tail- 
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lierung, kann es vorkommen, dass die tatsächliche Mittelpunktposition au- 
Berhalb des Mittelpunktbereiches liegt. Da dieser Umstand bei fahrerlosen 
Transportfahrzeugen nur in sehr seltenen Fällen auftritt, wird im weiteren 
Verlauf der Arbeit angenommen, dass Fahrzeuge keine ausgeprägte Taillie- 


rung aufweisen. 
projizierter Mittelpunkt 


FTF 
N 
Kamera Kamera 


FTF 


tatsächlicher Mittelpunkt 


Abbildung 5.3: Skizzierte Darstellung eines Objektes ohne und mit starker Taillierung. 


Feinpositionierung - FTF 


Mit Hilfe der Mittelpunktgüte kann eine Aussage darüber getroffen werden, 
mit welchem Fehler bei der Bestimmung der tatsächlichen Position gerech- 
net werden muss. Bei normaler Fahrt ist die Positioniergenauigkeit ausrei- 
chend, da bei einer Kollisionsbetrachtung nicht der Mittelpunkt, sondern 
die Form des Fahrzeuges herangezogen wird. Sie ist jedoch nicht ausrei- 
chend, wenn ein exakter Punkt, beispielsweise eine Halteposition vor einer 
Übergabestelle, angefahren werden soll. Durch die Feinpositionierung kann 
die Genauigkeit der Position besser bestimmt werden, als mit der bereits 
vorgestellten Methode „Objektposition“ (siehe Abschnitt 5.2). Ein weiterer 
Unterschied ist, dass die Feinpositionierung auf dem Fahrzeug selbst durch- 
geführt wird und nicht auf der Sensoreinheit. 


Umgesetzt wird die Feinpositionierung mit Hilfe eines Formvergleichs, ba- 
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sierend auf dem „interactive closest point“(ICP)-Algorithmus [19]. Die 
Feinpositionierung beruht auf dem Vergleich zweier Gruppen von Rand- 
punkten (siehe Abschnitt 5.3) unter Verwendung der euklidschen Distanz- 
transformation [11]. Eine Gruppe besteht aus den Randpunkten, die die tat- 
sächliche Form des Fahrzeuges bestmöglich wiedergeben und im Fahrzeug 
hinterlegt sind. Die zweite Gruppe ist zusammengesetzt aus Randpunkten 
des FTF, die zu Beginn der Feinpositionierung vom Kamerasystem ermittelt 
werden. Durch einen Formvergleich dieser beider Gruppen kann die aktu- 
elle Position ermittelt werden. Ist sowohl die Position des Fahrzeuges, als 
auch die Zielposition bekannt, wird eine Trajektorie berechnet, mit der das 
Fahrzeug auf kurze Distanz mit Hilfe odometrischer Führung die gewünsch- 
te Position anfährt. 

Während die aktuellen Randpunkte aus den vom Kamerasystem kommuni- 
zierten Eigenschaften ausgelesen werden können, können die hinterlegten, 
möglichst formechten Randpunkte auf zweierlei Weisen ermittelt werden. 
Entweder kann die Form manuell hinterlegt werden, oder sie kann direkt 
aus der übermittelten aktuellen Formeigenschaft ausgelesen werden, wenn 
sich das Fahrzeug in einer guten Position befindet. Eine gute Position zeich- 
net sich dabei dadurch aus, dass der Einfluss der Höhe eines Fahrzeuges 
auf die perspektivische Verzerrung möglichst gering ist. Diese Position des 
Fahrzeuges befindet sich im Lotfusspunkt des Kamerasystems. 

Da die Randpunkte in der Regel stark verrauscht sind, ist ein direkter Ver- 
gleich einzelner Punkte nicht möglich. Aus diesem Grund werden beide 
Formen grob übereinander gelegt, ausgerichtet und die Abweichung mit 
Hilfe der euklidschen Distanztransformation ermittelt. Anschließend wird 
versucht, den Fehler durch eine Position- und Rotationsänderung zu mini- 
mieren. Ist der Fehler minimal, kann eine präzise Aussage über die Position 


und die Orientierung getroffen werden. 


Beispiel Formabgleich. Im folgenden Beispiel (siehe Abbildung 5.4) sol- 
len zwei Objekte, dargestellt durch eine begrenzte Anzahl an Randpunkten, 
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so übereinandergelegt werden, dass es zu einer bestmöglichen Deckung 


kommt. 
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Abbildung 5.4: Zwei Formen werden miteinander verglichen, indem sie tiber die Mittelpunkte 
nah beieinander positioniert werden und anschließend mit Hilfe der euklidi- 
schen Distanztransformation die Position mit dem kleinsten Fehler gesucht 
wird. 


Eines der Objekte (rot) wird fixiert, während das blaue verschoben wer- 
den kann. Damit eine Aussage über die Güte der Position getroffen werden 
kann, wird ein Maß für den Fehler benötigt. Dieser Fehler lässt sich aus dem 
Abstand berechnen, den ein roter Randpunkt zum nächstgelegenen blauen 
Randpunkt aufweist. Dieser Abstand wird für jeden der blauen Randpunkte 
ermittelt. Aus der Summe aller Entfernungen kann anschließend ein Rück- 
schluss auf das Maß der Übereinstimmung gezogen werden. Gesucht ist 
die Position mit der kleinsten Summe aller Entfernungen. Eine Redukti- 
on des Rechenaufwandes wird dadurch erreicht, dass zu Beginn die beiden 
Mittelpunkte der Objekte berechnet und die Objekte so übereinandergelegt 
werden, dass die Mittelpunkte deckungsgleich sind (siehe Abbildung 5.4 
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3). Da es schon eine grobe Überdeckung gibt, können die Objekte in ge- 
ringerem Maße verschoben werden (siehe Abbildung 5.4, 4). Da für den 
Formabgleich die transformierten Randpunkte herangezogen werden, kann 


eine Skalierung durch die Entfernung ausgeschlossen werden. 
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Abbildung 5.5: Uberlagerung der gespeicherten und der aktuell sichtbaren Form 


Zu Beginn wird versucht eine Position anzufahren, die möglichst nahe an 
das Kameralot heranführt. Um mögliche Fehler auszugleichen werden die 
Randpunkte ins Kameralot transformiert, ausgerichtet und lokal auf dem 
Fahrzeug gespeichert. Die eigentliche Feinpositionierung erfolgt durch den 
bereits beschriebenen Formabgleich. Die gespeicherten Randpunkte werden 
durch die blaue Punktwolke wiedergegeben, während die roten Punkte die 
Randpunkte der aktuellen Position repräsentieren. Bevor die Summe aller 
Entfernungen berechnet wird, werden die beiden Punktwolken übereinander 
gelegt und die Richtung der gespeicherten Randpunkte an die der aktuellen 
Position angeglichen. 


Anschließend werden die gespeicherten Randpunkte entlang des Vektors, 
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welcher zwischen Kameralot und Mittelpunkt der aktuellen Position aufge- 
zogen wird, bewegt und bei jedem Schritt die Formabweichung mittels der 
Methode der euklidschen Distanztransformation gemessen. Damit es zu kei- 
nen Richtungsfehler kommt, wird darüber hinaus auch der Verdrehwinkel 
bei jedem Schritt mehrfach angepasst indem es um den Mittelpunkt gedreht 
wird. 

Eine Fehlerquelle die beim Formabgleich auftritt, sind die Abweichungen 
der Form auf Grund von perspektivischen Verzerrungen bzw. Verdeckun- 
gen. Es kann ein abgeschatteter Bereich entstehen, der zu einer Verfälschung 
der Form führen kann. Diese Verfälschung der Form tritt jedoch nur auf der 
von der Kamera abgewandten Seite eines Objektes auf. 

Der Einfluss dieses Fehlers kann durch eine zusätzliche Gewichtung der 
Randpunkte minimiert werden. Die Gewichtung wurde wie folgt umgesetzt. 
Der Randpunkt, welcher dem Kameralot am nächsten ist, wird mit einer eins 
gewichtet, während der, der vom Kameralot am weitesten entfernt ist eine 
Gewichtung von null zugewiesen bekommt. Der Gewichtung aller anderen 
Punkte ist proportional zum Lotfusspunktabstand und erhält einen Wert zwi- 
schen null und eins. Vorläufige Tests haben ergeben, dass Punkte, deren Ge- 
wichtung kleiner 0,5 ist, bei der Berechnung des Fehlers nicht berücksichtigt 
werden sollten. 

Am Ende wird die Verdrehung und der Versatz zur Feinpositionierung ge- 
wählt, bei der die Abweichung am geringsten war. Der Mittelpunkt kann 


nun für die Feinpositionierung verwendet werden. 


Geschwindigkeitsermittlung 


Die Geschwindigkeit ist eine wichtige Eigenschaft, die zur Selbstidentifika- 
tion genutzt werden kann. Die Ermittlung erfolgt, indem die transformierten 
Mittelpunktpositionen über mindestens zwei Bilder hinweg verglichen wer- 


den. Mit Hilfe des Gesetzes der gleichförmigen Bewegung 
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v=-, (5.2) 


mit s als zurückgelegte Strecke, basierend auf dem Abstand der beiden Mit- 
telpunkte zueinander und t als die zugehörige Zeit, basierend auf der Bild- 
rate, kann die Geschwindigkeit v berechnet werden. Eine Glättung der oft- 
mals schwankenden Geschwindigkeitswerte erfolgt unter Zuhilfenahme der 
exponentiellen Glättung 1. Ordnung und sollte die Reaktionszeit nicht zu 
sehr verlängern. Da die Glättung individuell sehr stark von dem zu glätten- 
den Objekt, dessen Fahrverhalten und Bewegungsabläufen abhängt, wird als 
Glättungsfaktor und als Vektorlänge ein sehr konservativer Wert gewählt. 
Für die Glättung wurde eine Gewichtung von & = 0,5 (siehe Abschnitt 
7.1.2) und eine Vektorlänge von 5 Bildern gewählt. Die exakten, versuchs- 
und fahrzeugrelevanten Faktoren werden auf Basis ausführlicher Versuche 
in Abschnitt 7.4.4 ermittelt. 


Richtungsbestimmung 


Die Richtungsbestimmung basiert auf einem ähnlichen Prinzip wie die Ge- 
schwindigkeitsbestimmung. Über mindestens zwei Bilder hinweg wird auf 
Basis der transformierten Mittelpunktpositionen ein Vektor berechnet, nor- 
miert und leicht geglättet. 

Die Glättung der oftmals schwankenden Richtungen erfolgt auch hier un- 
ter Zuhilfenahme einer exponentiellen Glättung 1. Ordnung. Da auch bei 
der Richtungsbestimmung bzw. der Orientierung die Glättung individuell 
sehr stark von dem zu glättenden Objekt, dessen Bewegungsverhalten und 
Bewegungsabläufen abhängt, werden ebenfalls sehr konservative Werte ge- 
wählt. So wurde @ auf 0,5 (siehe Abschnitt 7.1.2) und die Vektorlänge auf 
5 Bildern festgelegt. Die exakten, versuchs- und fahrzeugrelevanten Fakto- 
ren werden ebenfalls auf Basis ausführlicher Versuche in Abschnitt 7.4.4 


ermittelt. 
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5.3 Geometrie 


Die letzte der drei Eigenschaften bezieht sich auf die Geometrie der Objekte. 
Ziel ist es, die geometrischen Eigenschaften eines Objektes zu ermitteln, mit 


deren Hilfe eine spätere Identifizierung möglich ist. 


Maximale Höhe 


Unter der maximalen Höhe eines Objektes ist der höchste Punkt zu verste- 
hen, den ein Objekt aufweist. Die Ermittlung der maximalen Höhe findet 
noch während der Segmentierung statt. Bei der Segmentierung werden die 
einzelnen Bildpunkt nicht nur auf Zusammengehörigkeit untersucht, son- 
dern es wird gleichzeitig auch nach den Messwerten gesucht, die die größte 
Entfernung zur Bodenebene aufweisen. 

Gesucht wird nach den höchsten Punkten. Da es häufig zu Ausreißern 
auf Grund von Fehlmessungen kommt und diese naturgemäß die höchsten 
Punkte betreffen, werden die höchsten drei Messwerte präventiv herausge- 
filtert, um einer Verfälschung des Ergebnisses vorzubeugen. Der Wert drei 
wurde gewählt, da oftmals ein oder zwei Ausreißern beobachtet werden 
konnten. Um die Sicherheit noch ein wenig zu erhöhen wurde die Grenze 
auf drei festgelegt. Die maximale Höhe wird anschließend ermittelt, indem 
aus mehreren verbleibenden Messwerten mit einer, im Vergleich zu den 
restlichen Messwerten, großen Höhe der Mittelwert gebildet wird. Experi- 
mentell konnte ermittelt werden, dass das Herausfiltern der höchsten drei 
Messwerte und eine Mittlung über zehn Messwerte zu Ergebnissen führen, 
die die tatsächliche maximale Höhe mit geringen Schwankungen wiederge- 


ben. 


Durchschnittliche Höhe 


Die durchschnittliche Höhe wird, wie die maximale Höhe, schon während 


der Segmentierung ermittelt. Sie wird errechnet, indem über alle Bildpunkte 
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eines Objektes das arithmetische Mittel gebildet wird. Da die durchschnitt- 
liche Höhe, im Gegensatz zur maximalen Höhe, bei sich bewegenden Ob- 
jekten auf Grund perspektivischer Verzerrungen deutlich größeren Schwan- 


kungen unterliegt, wird sie im weiteren Prozess nicht weiter berücksichtigt. 


Minimale Höhe 


Die minimale Höhe wird auf die selbe Weise ermittelt wie die maximale 
Höhe. Der Unterschied ist, dass nicht nach den zehn größten Höhen gesucht 
wird, sondern nach den zehn kleinsten. Auch die minimale Höhe wird im 
weiteren Prozess nicht weiter berücksichtigt, da sie keinen Einfluss auf die 
Selbstidentifikation hat. Bei Fahrzeugen ohne überhängende Teile sind ent- 
weder die Reifen oder das Chassis zu sehen, die bis zum oder knapp über 
den Boden reichen. Aus diesem Grund weisen sie eine Höhe nahe Null auf, 
solange sie sich nicht im Kameralot befinden. 

In Sonderfällen kann das Wissen um die minimale Höhe jedoch sehr hilf- 
reich sein. So kann beispielsweise der niedrigste Punkt, der an einem Kran 
befindlichen Traglast abgeschätzt und die Ladung vorsichtig am Boden ab- 
gesetzt werden. 

In Abbildung 5.6 sind einige Objekte inklusive der ermittelten Höhen gra- 
fisch dargestellt. 


Fläche - FTF 


Das Attribut Fläche gibt den Flächeninhalt des projizierten Objektes wieder 
und die Berechnung erfolgt auf dem Fahrzeug. Berechnet wird die Fläche A 
anhand der Eckpunkte der abstrahierten Form, unter Verwendung der Gauß- 


schen Dreiecksformel [35]. 


1 


n 
A= > 2 Wi —¥-1) (5.3) 
i=l 
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~ ø 95 mm 
min 75 mm 
max. 1520 mm 

Ø 715 mm 

min. 75 mm 
340 mm 
320 mm 
300 mm 


Abbildung 5.6: Höhenprofil inklusive maximaler, durchschnittlicher und minimaler Höhen 


Umfang - FTF 


Die Eigenschaft Umfang gibt den Objektumfang eines Objektes an. Die Be- 
rechnung wird auf dem Fahrzeug ausgeführt und basiert, wie auch die Flä- 
chenberechnung, auf der abstrahierten Form. Die Ermittlung des Umfangs 


U erfolgt auf Basis des Satzes des Pythagoras. 


n 
u= L T —Xn)* + (Ynsi —Yn)* (5.4) 
i=] 


Form und Formabstraktion 


Die Form der Objekte spielt bei der Feinpositionierung als auch bei der Hin- 
dernisumfahrung eine wichtige Rolle. Neben dem Mittelpunkt eines Objek- 
tes ist das Wissen um die Form fiir eine erfolgreich Hindernisumfahrung 
essentiell. Nur wenn die geometrischen Maße bekannt sind, kann ein Ob- 


jekt in angemessenem Abstand umfahren werden. 
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Eine Übertragung aller Randpunkte eines Objektes hätte jedoch zur Folge, 
dass eine unnötig hohe Anzahl an Daten über die Kommunikation über- 
tragen werden müssten. Die Untersuchung der Länge einer Nachricht, die 
alle notwendigen Eigenschaften für eine Selbstidentifikation enthält, hat er- 
geben, dass die Form bei der Nachrichtenlänge eine entscheidende Rolle 
spielt. 

Die Auswertung mehrerer Messreihen ergab, dass das Versuchsfahrzeug, bei 
der verwendeten Kamera und bei der gegebenen Installationshöhe, durch- 
schnittlich über ungefähr 230 Randpunkte verfügt. Berücksichtigt man, dass 
ein Randpunkt sowohl in seiner ursprünglichen als auch in seiner Transfor- 
mierten Form übertragen wird und jeder Messwert aus einer ganzzahligen 
x-, y- und z-Koordinate inklusive Trennzeichen besteht, setzt sich die Eigen- 
schaft Form aus ca. 5250 Zeichen zusammen. Alle anderen Eigenschaften 
neben der Form können auf eine Länge von maximal 55 Zeichen reduziert 
werden. 

Aus diesem Beispiel geht hervor, dass das größte Potential einer Dezimie- 
rung der zu übertragenden Datenmenge, in einer Reduktion der Randpunkte 
liegt. Diese Reduktion basiert auf einer Abstraktion der Form. Ziel ist es, die 
Form mit möglichst wenigen Randpunkten, möglichst genau zu beschrei- 
ben. 

Es wurden verschiedene Ansätze zur Reduktion der Randpunkte implemen- 


tiert und analysiert, von denen vier vorgestellt und diskutiert werden: 


e Kreis, 

e Konvexe Hülle, 

e Douglas-Peucker Hülle, 
e Konkave Peucker-Hiille. 


Kreis Die einfachste und kompakteste Art eine Form zu abstrahieren, ist 
die Beschreibung durch einen Kreis. Die einzige zusätzliche Information ist 
der Radius. Dieser wird ermittelt, indem der Randpunkt gesucht wird, der 


am weitesten vom Mittelpunkt entfernt ist. Gemäß Abbildung 5.7 liegt jeder 
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Punkt des Objektes innerhalb des Kreises. Ein Fahrzeug, welches den Kreis 
als Hindernis wahrnimmt und ausweicht, kollidiert auch nicht mit dem Ob- 
jekt. 

Der Vorteil des Verfahrens ist, dass sich die Form durch eine einzige Zahl 
beschreiben lässt. Wie aus Abbildung 5.7 hervorgeht, besteht der Nachteil 
jedoch darin, dass große Bereiche überdeckt werden, die für ein Fahrzeug 
passierbar wären. Bei Objekten mit einem großen Breiten- und Längenver- 
hältnis fällt dieser Effekt stark ins Gewicht. Im schlechtesten Fall könnten 
eigentlich freie Fahrwege blockiert werden. 


Abbildung 5.7: Formabstraktion eines Beispielobjektes auf Basis eines Kreises. 


Konvexe Hülle Eine weitere Möglichkeit eine Form zu abstrahieren kann 
mit Hilfe einer konvexen Hülle umgesetzt werden. Eine konvexe Hülle ist 
die kleinste Menge einer Teilmenge, die die gesamte Ausgangsmenge ent- 
hält (siehe [6] Seite 2ff). 

Die in Abbildung 5.8 dargestellte Umrandung des Objektes ist stets nach 
außen gewölbt, konvex, und nicht nach innen. Das hat zur Folge, dass innen 
liegende freie Bereiche umschlossen und integriert werden. Kleine Berei- 


73 


5 Objekteigenschaften 


che, in Abb. 5.8 grün dargestellt, dienen der Vereinfachung der Form und 
sind im hiesigen Beispiel akzeptabel. Größere Bereiche, rot dargestellt, kön- 
nen jedoch hinderlich sein, da sie von anderen Objekten als Hindernis wahr- 
genommen und umfahren werden, obwohl es sich um frei passierbare Be- 


reiche handelt. 


Akzeptable 
Flächenvereinfachung 


Inakzeptable 
Flächenvereinfachung 


Abbildung 5.8: Formabstraktion eines Beispielobjektes unter Anwendung der konvexen Hül- 
le. 


Douglas-Peucker Die Abstraktion mittels des Douglas-Peucker Algorith- 
mus basiert auf einer Eckendetektion [7]. 

Umgesetzt wird die Detektion, indem zu Beginn der Punkt gesucht wird, 
welcher am weitesten vom Mittelpunkt entfernt liegt. Er stellt den ersten 
Punkt der abstrahierten Form dar. Anschließend wird der Punkt gesucht, 
der sowohl am weitesten vom Mittelpunkt, als auch am weitesten vom zu- 
vor gefundenen Punkt entfernt liegt (siehe Abbildung 5.9, Schritt 1). Dieser 
bildet den zweiten Punkt der abstrahierten Form. Durch die beiden gefun- 
denen Punkte kann nun eine Gerade gelegt werden. Anschließend wird der 
Randpunkt gesucht, der am weitesten von der Gerade entfernt ist. Die Ent- 
fernung ist in Abbildung 5.9, Schritt 2 mit durch ein x dargestellt. Bis zu 
diesem Zeitpunkt wurden bereits drei Punkte gefunden, die wiederum über 
drei Geraden miteinander verbunden sind, siehe Schritt 3. Ist der Abstand 


x des am weitesten von den Geraden entfernten Randpunktes größer als ein 
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bestimmter, vorher festgelegter Grenzwert, wird auch dieser in die Liste der 
abstrahierten Punkte aufgenommen. Die Abstandmessung wird fortlaufend 
für alle Randpunkte fortgeführt, die innerhalb zweier abstrahierter Punkte 
liegen und die Suche nach neuen Punkten so lange fortgesetzt, bis kein Ab- 


stand mehr den Grenzwert überschreitet. 


[2] s [3] 


Abbildung 5.9: Skizzierte Darstellung des Prozessablauf bei der Anwendung des Douglas- 
Peucker-Algorithmus. 


Im Gegensatz zur konvexen Hülle können mit dem Douglas-Peucker Al- 
gorithmus auch Hinterschnitte erkannt werden. Ein großer Nachteil dieses 
Verfahrens ist jedoch, dass Teile eines Objektes auch außerhalb der abstra- 
hierten Hülle liegen und so eine unsichtbare Gefahr für andere Verkehrsteil- 
nehmer werden können, siehe Abbildung 5.9, der in Schritt 4 rot markierte 
Bereich. Aus diesem Grund ist das Verfahren ungeeignet. Darüber hinaus 
neigt die abstrahierte Form zu starken Formänderungen. Dies ist darauf 
zurück zu führen, dass die Entfernungen der Randpunkte zu den Geraden 
oftmals sehr nahe beieinander liegen, so dass von einem Bild zum anderen 


gänzlich andere Punkte als Eckpunkte detektiert werden können. 


Konkave Peucker-Hülle Untersucht wurde eine eigens entwickelte Abs- 
traktionsmethode die auf einer Kombination der bereits vorgestellten Me- 
thoden basiert. Sie setzt sich zusammen aus einer konvexen Hülle und dem 


Douglas-Peucker Algorithmus mit dem Ziel, die Vorteile beider Methoden 
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zu vereinen. 

Zu Beginn wird eine konvexe Hülle errechnet, dargestellt in Abbildung 5.10 
unter [1]. Anschließend werden [2] die Abstände zwischen den gefundenen 
Eckpunkten ermittelt. Ist der Abstand zwischen zwei Eckpunkten ausrei- 
chend groß, wird nach einem Hinterschnitt gesucht. Zu diesem Zweck wird, 
unter Zuhilfenahme des Douglas-Peucker Algorithmus, als der dazwischen 
liegenden Teilmenge an Randpunkten der Punkte gesucht, der den größten 
Abstand zur Geraden aufweist. Überschreitet der Abstand einen bestimmten 
Grenzwert, wird der Randpunkt der Liste der Eckpunkte hinzugefügt. An- 
schließend wird erneut eine konvexe Hülle aus den beiden, neu entstandenen 


Teilmengen ermittelt [3]. 


Abbildung 5.10: Überwachter Bereich 


Anhand der in Abbildung 5.10 Schritt [3] dargestellten abstrahierten Form 
geht hervor, dass die ursprüngliche Form genau genug wiedergegeben wer- 
den kann, ohne dass die für eine Navigation störenden, großen freien Be- 
reiche überdeckt werden. Darüber hinaus verhindert die Verwendung der 
konvexen Hülle, dass Bereiche des Objektes fälschlicher weise abgeschnit- 


ten und für Fahrzeuge unsichtbar werden. 


Die Länge der Nachricht, welche die Eigenschaften enthält, konnten ab- 
hängig von der Objektform durch den Einsatz der konkaven Peucker-Hülle 
durchschnittlich von ca. 5250 Zeichen auf 450 Zeichen reduziert werden. 


Das entspricht einer 91,43%-tigen Reduktion der Datenmenge. 
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5.4 Kommunikation und Datenübertragung 


Nach der Erhebung werden die zu kommunizierenden Eigenschaften von 
der Sensoreinheit allen interessierten Systemen zur Verfügung gestellt. Die 
Datenübertragung erfolgt auf Basis des MQTT-Protokolls. 


Nach Christian Götz [14] ermöglicht das MQTT-Protokoll das Vernetzen 
vieler tausender Geräte und zählt aus diesem Grund zu den wichtigsten 
Protokollen im Internet der Dinge. Der zentrale Aspekt ist eine ereignis- 
gesteuerten Publish/Subscribe-Architektur. Vergleichbar mit einem Radio- 
sender können über Kanäle, so genannte „Topics“, Nachrichten in Form 
eines Strings veröffentlicht (published) werden, die von anderen Geräten 
abonniert (subscribed) und mitgelesen werden können. Im Gegensatz zur 
Request/Response-Methode muss keine Anfrage auf Informationen gestellt 
werden. Im Zentrum der Kommunikation steht ein Server (Broker), der die 
einzelnen Topics und Nachrichten verwaltet. Des weiteren verfügt MQTT 
über Mechanismen der Qualitätskontrolle, die aus drei Serviceleveln be- 
stehen. Unter Level 0 gibt es keine Garantie, dass die Nachricht angekom- 
men ist. Unter Level 1 wird sichergestellt, dass eine Nachricht mindestens 
ein Mal angekommen ist und Level 2 garantiert, dass die Nachricht genau 
einmal angekommen ist. Zu beachten ist jedoch, dass die benötigte Band- 


breite zunimmt, je höher das Servicelevel ist [14]. 


In unserem Fall der kommunikationsgestützten Lokalisierung veröffentlicht 
die Sensoreinheit in regelmäßigen Abständen die Eigenschaften, welche 
zum Beispiel von autonomen Fahrzeugen abonniert und ausgewertet wer- 
den können. Mit dem Ziel, die Menge an zu übertragenden Daten möglichst 
gering zu halten, werden die Eigenschaften mit dem Servicelevel 0 übertra- 


gen. 
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5.5 Zusammenfassung 


Zusammenfassend kann gesagt werden, dass im voraus gegangenen Kapi- 
tel mit der Erhebung der notwendigen Eigenschaften der Grundstein für die 
Selbstidentifikation gelegt wurde. Es wurden kinematische als auch geome- 
trische Eigenschaften herausgearbeitet. Außerdem wurde ein Verfahren ent- 
wickelt, welches es ermöglicht, die Anzahl der formgebenden Randpunkte 
eines Objektes um das zehnfache zu reduzieren und dadurch die zu übertra- 
gende Datenmenge deutlich zu reduzieren. Abschließend wurde das Kom- 
munikationsprotokoll MQTT vorgestellt, über das die Eigenschaften der 
Objekte zyklisch veröffentlicht und von anderen Systemen abonniert wer- 


den können. 
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Bei der Baysschen-Lokalisierung ist die Objektidentität bekann, während 
der Ort unbekannt ist. Bei dem hier beschriebenen Verfahren ist der Ort 
bekannt, jedoch die Objektidentität unbekannt. Deshalb folgt die kurze Ein- 
führung in die Baysche-Lokalisierung, welche die nachstehend Verfahren 
zu Zuordnung inspiriert hat. 

Die Grundlage einer jeden autonomen Navigation ist die Lokalisierung. 
Gemäß Abschnitt 2.1.1 wird in den meisten Fällen versucht, durch die Ver- 
wendung einer mitgeführten Sensorik, die eigene Position im Raum festzu- 
stellen. Im Gegensatz dazu sind bei der kommunikationsgestützten Loka- 
lisierung die Positionen aller Objekte bereits bekannt. Gesucht wird nicht 
die Position im Raum, sondern die korrekte Zuweisung eines Objektes zum 
Fahrzeug. Obwohl große Unterschiede zwischen den klassischen Lokali- 
sierungsproblemen und dem der kommunikationsgestützten Lokalisierung 
bestehen, können einige Ansätze übernommen werden. 

Einer dieser Ansätze ist die Bayes’sche-Lokalisierung (Fussnote: Bei Thrun 
auch als Markov-Lokalisierung als Bestandteil der probabilistischen Robo- 
tik bezeichnet). Diese modelliert die Zustandsfolge als Markovkette und die 
Beobachtungen nur vom aktuellen Zustand abhängig. Sie basiert auf einem 
fortlaufenden Ausschlussverfahren und nicht auf einer einzigen Schätzung. 
Die Position des Objektes wird über einen größeren Zeitraum hinweg ausge- 
wertet und kontinuierlich eingegrenzt, bis am Ende eine Position festgelegt 
werden kann, die mit großer Wahrscheinlichkeit der tatsächlichen Position 


entspricht. 
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Abbildung 6.1: Bayes’sche-Lokalisierung [30] 


In Abbildung 6.1 ist die Bayes’sche-Lokalisierung vereinfacht in drei Schrit- 
ten dargestellt. Sie beschreibt das Problem der initialen, globalen Lokalisie- 
rung nach Thrun [30]. Darstellt ist ein eindimensionaler Flur mit drei iden- 
tischen Türen. Da der Roboter anfänglich keine Informationen über seinen 
Aufenthaltsort hat, ist seine initiale „Annahme“ bel(xo) bezüglich seines 
Aufenthaltsorts an jeder Position gleich hoch. bel steht dabei für belief, also 
die Annahme an einer bestimmten Position zu stehen, ohne es zu wissen. 
Ließt der Roboter seine Sensoren aus und stellt fest, dass er neben einer Tür 
steht, multipliziert er seine angenommene Aufenthaltswahrscheinlichkeit 
bel(xo) mit der auf einem Beobachtungsmodell basierten Wahrscheinlich- 
keit p(zo|xo) (siehe Abb. 6.1, Schritt 1). Diese beschreibt die Wahrschein- 
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lichkeit, mit der an verschiedenen Stellen im Flur eine Tür zu beobachten 
ist. Bewegt sich der Roboter gemäß Abbildung 6.1 Schritt 2 nach rechts, 
wird seine „Annahme“ mit dem Bewegungsmodell gefaltet p(xz|u1,x¢-1). 
Das Ergebnis ist in Schritt 2 visualisiert. Das Diagramm zeigt eine verscho- 
bene, angenommene Aufenthaltswahrscheinlichkeit bel (xı), die durch die 
Faltung abgeflacht wird. Der letzte Teil der Positionsbestimmung wird in 
Schritt 3 der Abbildung 6.1 dargestellt. Hier wird der aktuelle Aufenthalts- 
glaube mit der Beobachtungsmodell basierten Wahrscheinlichkeit p(z;|xt) 
multipliziert. Es ist zu erkennen, dass die Aufenthaltswahrscheinlichkeit 
bel(x2) vor der zweiten Tür deutlich erhöht ist, so dass der Roboter sehr 
sicher ist, sich lokalisiert zu haben. 

Neben dem oben beschriebenen Problem der globalen Lokalisierung gibt es, 
nach Thrun [30], noch zwei weitere Typen von Lokalisierungsproblemen. 
Alle drei Typen können auch auf die kommunikationsgestützte Lokalisie- 
rung übertragen werden und werden im Folgenden aufgelistet, erläutert und 


sind von oben nach unten nach zunehmender Schwierigkeit sortiert: 


e Positionsverfolgung (Position tracking) 
Initiale Position ist bekannt. Rauschen wird kompensiert. Rauschen 
ist in der Regel klein und wird als unimodale Gaußverteilung model- 
liert. Es handelt sich um ein lokales Problem in der Nähe der tatsäch- 


lichen Roboterposition. 


Globale Lokalisierung (Global localization) 
Initiale Position ist unbekannt. Keine Begrenztheit der möglichen Po- 


sition innerhalb des überwachten Bereichs. 


Kidnapped Robot Problem. Variante des globalen Lokalisierungspro- 
blems, jedoch schwieriger. Position des Fahrzeuges könnte telepor- 
tiert werden, ohne dass es das Fahrzeuges bemerkt. Es würde davon 


ausgehen, dass es weiß, wo er sich aktuell aufhält. 


Kommunikationsgestützte Lokalisierung 


Bei der kommunikationsgestützten Lokalisierung handelt es sich, wie im 
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obigen Abschnitt erwähnt, nicht um ein klassisches Lokalisierungsproblem, 
sondern um eine Zuordnung. Die Positionen aller Objekte sind bereits be- 
kannt. Damit ein Fahrzeug in der Lage ist, sich unter den anderen Objekten 
zu erkennen, werden ihm eine Reihe von Eigenschaften (siehe Kapitel 5) 
zur Verfügung gestellt. Ziel ist es, mit Hilfe der Eigenschaften ein Fahrzeug 
mit einer bestimmten Wahrscheinlichkeit identifizieren zu können. 

Erreicht wird dies, indem die durch das Kamerasystem ermittelten Eigen- 
schaften aller Objekte mit den tatsächlichen Eigenschaften des Fahrzeuges 
verglichen werden. Basierend auf den Übereinstimmungen, kann eine Wahr- 
scheinlichkeitsaussage getroffen werden, ob es sich bei dem veröffentlichten 
Objekt um das gesuchte Fahrzeug handelt oder nicht. 

Neben der Position wird hierfür auf folgende Eigenschaften zurückgegrif- 


fen: 


Position 


Status 


Geschwindigkeit 


Bewegungsrichtung 
Höhe 

Fläche 

Umfang 


Geschätzte Position (intern) 


Geschwindigkeit (intern) 


In Abschnitt 6.1 werden alle diese Eigenschaften einer genaueren Untersu- 
chung unterzogen. Da die Messwerte oftmals stark verrauscht sind, werden 
passende Wertebereiche ermittelt, in deren Grenzen eine Selbstidentifizie- 
rung wahrscheinlich ist. Anschließend werden in Abschnitt 6.2 die einzel- 
nen Eigenschaften auf ihre Bedeutsamkeit hin evaluiert, priorisiert und ge- 
wichtet. Die Untersuchung der Eigenschaften erfolgte zum einen auf Basis 
von Modellen oder auf Basis von Versuchen. Zuletzt werden in den Ab- 


schnitten 6.3, 6.4, 6.5 die Selbstidentifikation erläutert, welche abhängig 
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vom jeweiligen Lokalisierungsproblem ist. 

Die Durchführung der Versuche erfolgte dadurch, dass ein Fahrzeug für ei- 
ne gewisse Zeit eine Strecke in Form einer 8 mit 0,2 m/s abgefahren ist. 
Während der Fahrt wurden alle Eigenschaften aufgezeichnet, die vom Ka- 
merasystem publiziert wurden, und ausgewertet. 

Die ermittelten Fehler wurden über die Häufigkeit ihres Auftretens auf- 
getragen, visualisiert und auf Basis der größten Häufigkeit normiert. An- 
schließend wurde für die Verteilung eine beschreibende Funktion ermittelt, 
mit deren Hilfe die Wahrscheinlichkeit des Auftretens in Abhängigkeit vom 
Fehler errechnet werden kann. Es wurden über 3.450 Messwerte für jede 
untersuchte Eigenschaft ermittelt. Da es einige Eigenschaften gibt, die nur 
schwierig zu verallgemeinern sind, wie beispielsweise die Form, welche 
stark von der Geometrie eines Objektes abhängt, wurden die Untersuchun- 
gen auf ein Objekt festgelegt. Verwendet wurde das selbe Versuchsfahrzeug, 
welches auch in der Funktionsdemonstration verwendet wurde (siehe Ab- 
schnitt 7.2.2). Darüber hinaus ist bei den Untersuchungen auf Allgemein- 
gültigkeit darauf geachtet worden, ohne großen Aufwand neue Fahrzeuge 


integriert werden können. 


6.1 Analyse der Objekteigenschaften 


Die Eigenschaften beeinflussen die Erkennung unterschiedlich stark. Ziel ist 
es, in diesem Unterkapitel die Wertebereiche der einzelnen Eigenschaften 
aller Objekte zu ermitteln und zu priorisieren. Anschließend werden diese 
mit den eigenen Eigenschaften des Versuchsfahrzeuges korreliert, um eine 


Übereinstimmung zu finden. 
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6.1.1 Position 


Die Position bezieht sich auf die perspektivische Sicht eines Objektes und 
wird gemäß Abschnitt 5.2 ermittelt. Darüber hinaus handelt es sich bei der 
Position um die globale Position eines Objektes im überwachten Bereich. 
Bevor der Mittelpunkt weiter verwendet wird, ist eine Transformation not- 
wendig. Wie bereits in Abschnitt 5.2 erwähnt, kann die Position zwar einem 
großen Fehler unterliegen. Der Fehler kann jedoch niemals größer sein, als 
der Abstand zwischen dem Punkt des Objektes, der am weitesten vom Mit- 
telpunkt entfernt liegt und dem Mittelpunkt. Bei still stehenden Objekten ist 
der Mittelpunkt sehr stabil. Obwohl die äußeren Ränder eines Objektes stark 
verrauscht sind, verschiebt sich die Mittelpunktposition selten um mehr als 
ein Pixel. Das liegt daran, dass sich das Rauschen auf gegenüber liegenden 
Seiten aufhebt. Bei einem sich bewegenden Objekt, muss hingegen der la- 


tenzabhängige Positionierfehler berücksichtigt werden. 


6.1.2 Status 


Der Status beschreibt den Zustand eines Objektes und ist in die drei Zustän- 
de „statisch“, „dynamisch“ und „inventarisiert“ unterteilt. 

Während die Zustände „statisch“ und „dynamisch“ zuverlässiger vom Fahr- 
zeug selbst ermittelt werden können und deshalb für die Selbstidentifikation 
irrelevant sind, wird der Status ,,inventarisiert“ manuell festgelegt. Eine In- 
ventarisierung Kann nur von einem Menschen vorgenommen werden, wes- 
halb dieser Wert als zuverlässig gilt. Ist ein Objekt inventarisiert, ist es un- 
veränderlich an eine Position gebunden und kann nur von einen Menschen 


wieder deinventarisiert werden. 
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6.1.3 Geschwindigkeit 


Die Geschwindigkeit kann auf zweierlei Weisen ermittelt werden. Einerseits 
durch das externe Sensorsystem und andererseits durch eine Auswertung der 
Odometriedaten auf dem FTF selbst. In diesem Abschnitt wird die Ermitt- 
lung durch das externe Sensorsystem betrachtet. 

Die Berechnung der Geschwindigkeit erfolgt durch die Untersuchung der 
Veränderung des Mittelpunktes über eine bestimmte Zeit und kann starken 
Schwankungen unterliegen. Das liegt daran, dass die Bewegung des Mit- 
telpunktes stark von äußeren Einflüssen wie der Perspektive, der Geome- 
trie des Fahrzeuges und vom Fahrwerk des Fahrzeuges abhängig sind. Die- 
se Schwankungen wurden durch die Durchführung der bereits im oberen 
Abschnitt erwähnten Versuche analysiert. Über einen begrenzten Zeitraum 
hinweg wurden die Geschwindigkeitswerte durch das Kamerasystems auf- 
gezeichnet und mit der tatsächlichen Geschwindigkeit von konstant 0,2 m/s 
verglichen. 

Zu diesem Zweck wurden die Abweichungen der gemessenen Geschwin- 
digkeiten errechnet und nach der Häufigkeit ihres Auftretens eingeteilt. An- 
schließend wurden die Häufigkeitsverteilung auf ihren Maximalwert nor- 
miert. In Abbildung 6.2 sind diese Häufigkeiten in Abhängigkeit der Ab- 
weichung aufgetragen. 

Es ist zu erkennen, dass die Geschwindigkeit Schwankungen unterliegt, 
wobei über 70% der Schwankungen kleiner + 0,05 m/s betragen. Auffällig 


ist das vermehrte Auftreten von Abweichungen in positiver Richtung. Der 


Grund für diese Asymmetrie ist dem Fahrwerk des Testfahrzeuges geschul- 
det (siehe Abschnitt 7.2.2). Da der Drehpunkt des Fahrzeuges außerhalb des 
Mittelpunktes liegt, schwenkt es bei jeder Richtungsänderung aus, wodurch 
die Bewegungsrichtung des Mittelpunktes von einer Rotationsbewegung 


überlagert wird. Das Resultat dieser Überlagerung ist eine vermeintlich hö- 
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Häufigkeit 


-0,10 -0,05 000 005 010 0,15 0,20 
Abweichung [m/s] 


Abbildung 6.2: Häufigkeit der Geschwindigkeitsabweichung 


here Fahrgeschwindigkeit (siehe Abbildung 7.30 (b)). 


Im späteren Verlauf des Kapitels spielt die ermittelte Verteilung der Ge- 
schwindigkeitsabweichungen eine wichtige Rolle. Mit dem Ziel einer einfa- 
cheren Handhabung, wird diese mit Hilfe einer Extremfunktion angenähert, 
die in Abbildung 6.2 als rote Linie dargestellt ist. 

Die an die Messwerte angepasste Verteilung der Geschwindigkeitsabwei- 
chung sieht wie folgt aus: 


x+0,00202 
-5 ) 


-0.01823 /__ x+0,00202 
(—exp 01829 = TO 


fig) = exp oy (6.1) 


BestimmtheitsmaB: 0,8107 


86 


6.1 Analyse der Objekteigenschaften 


6.1.4 Bewegungsrichtung 


Auch die Bewegungsrichtung wurde ermittelt und auf Basis von Versuchen 
analysiert (siehe Abschnitt 7.4.3). Als Referenz wurden die Orientierungen 
aus den odometrischen Daten des Versuchsfahrzeuges gewählt, aufgezeich- 
net, angepasst und mit den Messwerten des Kamerasystems verglichen. Die 
Güte der odometrischen Daten wurde mit Hilfe eines speziellen Versuchs 
ermittelt (siehe Abschnitt 7.4.3). 

Die Berechnung der Bewegungsrichtung beruht auf der Änderung aufein- 
ander folgender Mittelpunktpositionen. Über den Versatz beider Positionen 
kann die Bewegungsrichtung des Objektes ermittelt werden. 

Es wurden die Richtungsabweichungen zwischen der Odometrieorientie- 
rung und der durch die externe Sensoreinheit ermittelte Richtung berechnet 
und nach der Häufigkeit des jeweiligen Auftretens eingeteilt. Anschließend 
wurden die Häufigkeiten normiert, indem die größte Häufigkeit auf eins ge- 
setzt wurde. In Abbildung 6.3 sind diese Häufigkeiten in Abhängigkeit der 
Abweichung aufgetragen. 


Auch hier ist zu erkennen, dass die Richtungsangaben starken Schwankun- 


gen unterliegen, wobei über 92 % der Messwerte Abweichungen von + 18° 
aufweisen. 

Die Näherungsfunktion, welche die Abweichungen beschreibt, basiert auf 
einer Gaussfunktion und ist in Abbildung 6.3 in Form einer roten Linie dar- 


gestellt. Die resultierende Gaussfunktion sieht wie folgt aus: 


(x — 2,6) 


2 
10,754 y). en 


fix) = 1-exp(—0,5-( 


Bestimmtheitsmaß: 0,9364 
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Häufigkeit 
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Abbildung 6.3: Häufigkeit der Richtungsabweichung 


6.1.5 Höhe 


Die Eigenschaft „Höhe“ beschreibt die maximale Höhe eines Objektes. In 
dem hier verwendeten Beispiel hat das unbeladene Fahrzeug eine maximale 
Höhe von 260 mm. Beladen mit zwei Ladungsträger kann eine maximale 
Höhe von 600 mm erreicht werden. Dazu kommt, dass die Messwerte in 
z-Richtung starkem Rauschen unterliegen, welches berücksichtigt werden 
muss. Das Rauschen der Entfernungsmesswerte wurde bereits in Abschnitt 
4.1.6 untersucht und wird bei der Bestimmung der Höhe berücksichtigt. 

Da die Wahrscheinlichkeit, dass es sich um die passende Höhe handelt, im 
gesamten Bereich zwischen 260 mm und 600 mm gleich hoch ist, muss der 
Wertebereich unter Berücksichtigung des Rauschens in drei Teile unterteilt 
werden. Der Grund für die gleichbleibende Wahrscheinlichkeit ist, dass kei- 


ne Aussage über die Höhe des Ladungsträger getroffen wird. Es wird davon 
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ausgegangen, dass ein Ladungsträger zwischen den beiden Grenzen jede be- 
liebige Höhe annehmen kann. 

Der in Abbildung 6.4 dargestellte Bereich 1 gibt die Wahrscheinlichkeit wie- 
der, mit der es sich unterhalb der Mindesthöhe immer noch um das gesuchte 
Fahrzeug handeln kann. Die Wahrscheinlichkeit in Bereich 2 ist Konstant, 
da die Ladungshöhe jeden Wert bis zu einer willkürlich festgelegten Maxi- 
malhöhe von 600 mm einnehmen kann und fällt dann, oberhalb der Maxi- 


malhöhe in Bereich 3 wieder ab. 


Bereich 1 Bereich 2 Bereich 3 


2 c=) 
fo) lo) 
i 1 


Wahrscheinlichkeit 
= 
i 


a 


0,04 


T T r T T i T ii T 
0 200 400 600 800 1000 
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Abbildung 6.4: Häufigkeit der Höhenabweichung 


Aus den Messungen aus Abschnitt 4.1.4 geht hervor, dass die Höhe starken 
Schwankungen unterliegt. Über 90% der Messwerte weisen Abweichungen 
zwischen -160 mm und +160 mm auf. Die Abweichungen beschreibenden 
Näherungsfunktionen, in Abbildung 6.4 als rote Linien dargestellt, basiert 
auf einer exponentiellen Wachstumgsfunktion in Bereich 1 und einer expo- 
nentiell abnehmenden Funktion in Bereich 3. Beide Funktionen können wie 


folgt beschrieben werden: 
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Bereich 1: Höhe < Fahrzeugmindesthöhe 


x 


fix) = 0, 1017 - exp'36971) — 0,09406 (6.3) 


Bestimmtheitsmaß: 0,98535 


Bereich 2: Höhe >= Fahrzeugmindesthöhe und Höhe <= Fahrzeugmaximal- 
höhe 


fo) = 1 (6.4) 
Bereich 3: Höhe > Fahrzeugmaximalhöhe 


—(x—600) ) 


—(x—600) 
fig) = 0,47534- exp 598 ) + 0,545 - exp! Wo ) (6.5) 


BestimmtheitsmaB: 0,98529 


6.1.6 Flache 


Die Fläche ist die von der Kamera detektierte unkorrigierte evtl. perspekti- 
visch verzerrte Darstellung einer Objektoberfläche. Im Gegensatz zu den 
voran gegangenen Eigenschaften wurde der flächenbeschreibende Werte- 
bereich auf Basis eines Modells ermittelt. Der Wertebereich ist durch eine 
Mindestgröße und eine Maximalgröße definiert. 

Um eine Aussage über die Fläche treffen zu können, müssen zu Beginn ei- 
nige Einflussparameter ermittelt werden. Einfluss auf die zu sehende Fläche 
hat die Grundfläche des Fahrzeuges, die Form, die Höhe, die Entfernung 
zum Kameralot als auch die Orientierung. Es wird angenommen, dass die 
Grundfläche und die Form des Fahrzeuges bekannt sind. In Abbildung 6.5 
ist diese vereinfacht durch vier graue Eckpunkte dargestellt. Auch bekannt 


ist die maximale Höhe und die Entfernung des Mittelpunktes zum Kame- 
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ralot. Da eine Schattenbildung die zu sehende Gesamtfläche im Vergleich 
zur Grundfläche immer vergrößert, kann die Grundfläche als Minimalgröße 
der Fläche festgelegt werden und beschreibt die untere Grenze des Werte- 
bereichs. 

Die Bestimmung der Maximalgröße fällt im Vergleich zur Minimalgröße 
komplexer aus. Damit die Maximalgröße berechnet werden kann, muss im- 
mer vom ungünstigsten Fall ausgegangen werden. Bezogen auf die maxi- 
male Höhe heißt das, dass diese für das gesamte Fahrzeug angenommen 
werden muss, da keine Aussage darüber getroffen werden kann, wo sich der 


höchste Punkt auf dem Fahrzeug befindet. 


400 5 
350 - x Kameralot 
x Mittelpunkt 
300 - © Draufsicht 
> —— Verdrehnt 
250 - —*—transformiert 
° © 
s —— kombiniert 
x 
200 - N 
Ò ów, 
150 T T T 
200 300 400 500 


Abbildung 6.5: Abhängigkeit zwischen Grundform und Schatten 


Zu Beginn wird die ungünstigste Position festgelegt. Diese liegt auf der Dia- 
gonalen, da dort der Einfluss der Perspektive auf die Verzerrung in x- und 
y-Richtung am Größten ist. Anschließend werden die Eckpunkte, in Ab- 
hängigkeit von der Höhe und der Entfernung zum Kameralot, transformiert. 
Die größte Fläche, die durch die Grundform inklusive der transformier- 
ten Punkte entstehen kann, wird mit Hilfe einer Umhüllenden beschrieben. 


Diese wird errechnet, indem aus der Punktemenge, die sowohl die Punkte 
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der Grundfläche, als auch die transformierten Punkte enthalten, eine kon- 
vexe Hülle gebildet wird (siehe Abbildung 6.5, rote Umrandung). Die Be- 
rechnung der Gesamtfläche erfolgte durch die Verwendung der Gaußschen 
Trapezformel, die auf die resultierenden Punkte der konvexen Hülle ange- 
wendet wird [35]. 


Abschließend wurde der Einfluss der Orientierung empirisch ermittelt, in- 
dem das Objekt rotiert und die Orientierung & bestimmt wurde, bei der die 
Größe der Fläche maximal ist. Abhängig von der Anfangsorientierung und 
der Grundform des Fahrzeuges, lag & für die maximale Fläche bei 71°. 

Die Modell beschreibende Näherungsfunktion des Maximalwertes besteht 
aus zwei verschachtelten linearen Gleichungen, die einerseits von der maxi- 
malen Objekthöhe h und der Entfernung des Objektes zum Kameralot s ab- 
hängig sind. Alle weiteren Randbedingungen könne in Abhängigkeit dieser 
beiden Parameter bestimmt werden. Die resultierende Näherungsfunktion 


kann wie folgt angegeben werden: 
Amax = (6,516E"% -h — 0,000131) - s + (0,000222-h+0,9945). (6.6) 


6.1.7 Umfang 


Ähnlich der Fläche beschreibt die Größe „Umfang“ den Umfang des proji- 
zierten Objektes. Die Methode, mit der der Umfang berechnet wird, basiert 
auf der selben Methode, mit der die Fläche berechnet wird. Der Wertebe- 
reich ist auch hier durch eine Mindest- und eine Maximalgröße definiert. 

Der kleinste Umfang ist gegeben, wenn das Fahrzeug direkt im Kamera- 
lot steht. Dieser kleinst mögliche Umfang beschreibt die Mindestgröße des 
Wertebereichs. Die obere Grenze des Wertebereichs ergibt sich durch die 
Berechnung der maximal größten Projektion des Fahrzeuges, abhängig von 
den selben Einflussparametern von denen auch die Fläche abhängig ist. Da- 


zu zählen die projizierte Fläche, die Form, die Höhe, die Entfernung zum 
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Kameralot als auch die Orientierung. Der Unterschied zwischen der Be- 
rechnung der Fläche und des Umfangs zeigt sich nachdem die Eckpunkte 
mit Hilfe der konvexen Hülle ermittelt wurden. Der Umfang U wird be- 
rechnet, indem gemäß Abschnitt 5.3 der Satzes des Pythagoras angewendet 
wird. 

Die Näherungsfunktion des Maximalwertes ist aus zwei verschachtelten li- 
nearen Gleichungen zusammengesetzt, die jeweils von der maximalen Ob- 
jekthöhe h und der Entfernung des Objektes zum Kameralot s abhängig sind. 


Die resultierende Näherungsfunktion kann wie folgt angegeben werden: 
Amax = (1,5545E °° . h — 0,0000197) - s + (0,00016-h+0,9974). (6.7) 


6.1.8 Interne Geschwindigkeit 


Die interne Geschwindigkeit gibt die odometrisch ermittelte Geschwindig- 
keit wieder. Sie ist abhängig von den Radumdrehungen, der Zeit und dem 
Raddurchmesser. Sind alle Variablen bekannt, können die Geschwindigkei- 
ten vı und v2 der beiden Antriebsräder bestimmt werden (siehe Abschnitt 
7.2.2). Die resultierende Geschwindigkeit v ergibt sich wie folgt aus dem 
Mittelwert der einzelnen Geschwindigkeiten: 
vi +v2 
Y= (6.8) 


Auch die interne Geschwindigkeit wurde auf Basis der beschriebenen Ver- 


suche untersucht. Über einen begrenzten Zeitraum hinweg wurden die odo- 
metrischen Geschwindigkeitswerte mit der tatsächlichen Geschwindigkeit 
von konstant 0,2 m/s verglichen. 

Zu diesem Zweck wurden die Abweichungen der odometrischen Geschwin- 
digkeiten errechnet und nach der Häufigkeit ihres Auftretens eingeteilt. An- 


schließend wurden die Häufigkeiten normiert, indem die größte Häufigkeit 
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Häufigkeit 


-0,10 -0,05 0,00 0,05 0,10 
Abweichung [m/s] 


Abbildung 6.6: Häufigkeit in Abhängigkeit der Geschwindigkeitsabweichung 


auf eins gesetzt wurde. In Abbildung 6.6 sind diese Häufigkeiten in Abhän- 
gigkeit der Abweichung aufgetragen. 

Es kann bemerkt werden, dass die Abweichungen im Vergleich zu denen 
durch das externe Sensorsystem ermittelten Geschwindigkeiten deutlich ge- 
ringer ausfallen. Über 98% der Messwerte weisen einen Fehler auf, der klei- 
ner ist als +0,01 m/s. 


Eine Näherung wurde auf Basis einer Gaußfunktion umgesetzt und ist an 


Abbildung 6.6 in Form einer roten Linie dargestellt. Die resultierende Nä- 


herungsfunktion kann wie folgt angegeben werden: s 


(-0,5-( e-0.00246) y2) 


A=l1-exp (6.9) 


Bestimmtheitsmaß: 0,99371 
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6.1.9 Interne Schätzposition 


Die geschätzte Position beschreibt eine odometrisch ermittelte Position des 
Fahrzeuges, ausgehend von der letzten vom Sensorsystem übertragenen Po- 
sition. Wird zum Beispiel die Sicht des Sensors auf das Fahrzeug durch 
ein anderes Objekt oder einem vorbei laufenden Menschen verdeckt, kann 
das Fahrzeug für kurze Zeit rein odometrisch weiterfahren. Bei erneutem 
Sichtkontakt mit dem Sensor, wird die geschätzte Position mit der des Sen- 
sorsystems verglichen und korrigiert, siehe Abschnitt 6.3. 

Die Genauigkeit der geschätzten Position ist abhängig von den verwendeten 


Motoren und dem Schlupf der Reifen des Fahrzeuges. 


6.2 Nutzwertanalyse der Objekteigenschaften 


Neben der Definition der Wertebereiche der Eigenschaften ist auch eine 
Priorisierung notwendig. Nicht alle Eigenschaften haben die selbe Aussa- 
gekraft. Der Status zum Beispiel, der von einer Person festgelegt wird, be- 
kommt eine höhere Gewichtung als die Fläche, die abhängig von einer Viel- 
zahl an Parametern stark variieren kann. Diese Priorisierung wird mit Hilfe 
einer Nutzwertanalyse umgesetzt. 

Zu diesem Zweck wurde jede Eigenschaft mit jeder anderen Eigenschaft 
verglichen und bewertet. Die Skala der Bewertung erstreckt sich hierbei von 
eins und fünf. Gemäß Tabelle 6.1 steht eins für einen deutlich geringeren 
Einfluss, drei für einen gleichgroßen und fünf für einen deutlich größeren 


Einfluss, der einen Eigenschaft verglichen mit der anderen. 


Tabelle 6.1: Bewertungsskala 
Einfluss | viel geringer gleich viel größer 


Notenvergabe | 1 2 3 4 5 
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Eine Gegenüberstellung aller Eigenschaften und deren Bewertungen finden 
sich in Tabelle 6.2 wieder. Nach dem Vergleich aller Eigenschaften, wurden 
die Bewertungen jeder einzelnen Eigenschaft aufsummiert. Mit Hilfe der 
Summen der Bewertungen konnte in einem nächsten Schritt die Priorität 


festgelegt und die Gewichtung abgeleitet werden. 


Tabelle 6.2: Alle Eigenschaften wurden einander gegenüber gestellt und miteinander vergli- 
chen. Aus der Summe der Bewertungen wird eine Priorisierung abgeleitet. 


externe Messwerte interne Messwerte 
Pos. Status Geschw. Richt. max.Höhe Umfang Fläche Pos. Richt. Geschw. 
Position 3 4 2 1 1 1 1 3 2 3 
Status 2 3 1 1 1 1 1 2 1 2 
Geschw. 4 5 3 2 2 2 1 4 2 4 
Richtung a 5 4 3 3 3 1 5 4 4 
Höhe 5 5 4 3 3 4 2 5 4 4 
Umfang 5 5 4 3 2 3 2 S 4 4 
Fläche F) 5 5 5 4 4 3 5 5 Si 
Position 3 4 2 1 1 1 i 3 2 3 
Richtung 4 5 3 3 2 2 1 4 zi 3 
Geschw. 3 4 2 2 2 2 1 kJ 3 3 
Summe 39 45 30 23 21 23 14 39 31 33 


Von links nach rechts, beginnend mit der größten Gewichtung, gibt Tabel- 
le 6.3 die nach Aussagekraft sortierten Eigenschaften wieder. Während die 
erste Zeile die Summe der Bewertungen aus der Nutzwertanalyse widerspie- 


gelt, sind diese in der zweiten Zeile normiert. 


Tabelle 6.3: Dargestellt sind alle Eigenschaften, nach ihrer Priorität sortiert. 


int. int. int. 
Priorität Status Pos. Pos. Geschw. Richt. Geschw. Richt. Umfang max.Höhe Fläche 
Ergebnis 45 39 39 35 31 30 23 23 21 14 
Gewichtung 0,15 0,13 0,13 0,117 0,103 0,1 0,077 0,077 0,07 0,046 


In den folgenden Abschnitten wird die Gewichtung variieren, da bei den un- 
terschiedlichen Lokalisierungsproblemen auf unterschiedliche Eigenschaf- 


ten zurückgegriffen wird. 
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6.3 Positionsverfolgung 


Die Positionsverfolgung, englisch „positional tracking“ ist das nach Thrun 
[30] am einfachsten zu lösende Lokalisierungsproblem. Bei dieser Proble- 
matik ist das Ziel, die bereits bekannte Position zu aktualisieren. 

Im Fall der kommunikationsgestützten Lokalisierung wird eine erneute Zu- 
ordnung durchgeführt. Diese wird anhand der schematischen Darstellung 
eines Objektes in zwei aufeinander folgenden Bildern (siehe Abbildung 6.7) 
deutlich. Zu sehen ist ein blaues Objekt, welches sich in Richtung des Bild- 
mittelpunktes bewegt. Der in Bild 2 zu sehende Schatten, stellt die ursprüng- 
liche Position des Fahrzeuges aus Bild 1 dar. Ziel ist es, das in Bild 2 erneut 


gefundene Objekt dem zuvor gefundenen Fahrzeug zuzuweisen. 


Bild 1 Bild 2 


Oon ¢ r=200mm 


Abbildung 6.7: Das Objekt aus Bild 2 kann dem Objekt aus Bild 1 zugordnet werden, da sich 
die Position nur sehr geringfügig verändert hat. 


Der dargestellte Fall stellt eine einfache Situation dar. Da sich das gesuchte 
Objekt, hier das Versuchsfahrzeug, nicht sehr schnell bewegt, fallt die Ver- 
änderung der Mittelpunktposition nicht sehr groß aus. Deshalb kann in der 
Nähe der ursprünglichen Position nach einem Mittelpunkt gesucht werden. 
Der Radius r des Suchfeldes ist in Abbildung 6.7 als gestrichelter Kreis 
dargestellt. Dieser ergibt sich aus dem Abstand des Mittelpunktes zu dem 
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Randpunkt, der ihm am nächsten liegt und weißt im hiesigen Beispiel eine 
Größe von 200 mm auf. Liegt der Mittelpunkt des Objektes des Folgebil- 
des, in Abbildung 6.7 als hellblauer Punkt in Bild 2 dargestellt, innerhalb 
des Suchfeldes, handelt es sich mit großer Wahrscheinlichkeit um das selbe 
Objekt. 

Schwieriger wird es, wenn sich das Fahrzeug mit hoher Geschwindigkeit be- 
wegt oder eine Aktualisierung über einen längeren Zeitraum nicht möglich 
ist. In diesem Fall sind der alte und der neue Mittelpunkt weit voneinan- 
der entfernt, so dass mehrere Objekte als das gesuchte Fahrzeug in Frage 
kommen. Ein Grund für eine solche Situation kann neben einer hohen Ge- 
schwindigkeit der kurzzeitige Ausfall der Kommunikation oder ein Verlust 
des Sichtkontaktes auf Grund einer Verdeckung sein. In diesem Fall muss 
eine weitere Größe mit einbezogen werden, die geschätzte Position (siehe 
Abschnitt 6.1). 


Bild 1 Bild 2 


l'odo = 120 mm 


®_ r=200 mm 


Abbildung 6.8: Das Objekt aus Bild 2 kann dem Objekt aus Bild 1 zugordnet werden, da die 
geschätzte Position mitgeführt wurde. 


Gemäß Abschnitt 6.1, kann unter Verwendung der odometrischen Daten die 
Position des Fahrzeuges geschätzt und somit der Suchraum deutlich redu- 
ziert werden. In vorausgegangenen Versuchen wurde gezeigt, dass der Odo- 


metriefehler bei einem ähnlichen Fahrzeug mit vergleichbaren Antrieben, 
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Abmaßen und Raddurchmessern einen durchschnittlichen Fehler von ca. 


+30 mm auf einen Meter aufweist [2]. Anhand von Stichproben konnte die- 
ser Wert auch für das hier verwendete Versuchsfahrzeug bestätigt werden. 
Aufgrund der Abweichungen und eines damit verbundenen Kollisionsrisi- 
kos ist die Blindfahrt eines Fahrzeuges auf maximal einen Meter beschränkt 
und der Fehler fodo auf 40 mm/m erhöht worden. 

Um nach einer Blindfahrt das Risiko einer Verwechslung, hervorgerufen 
durch eine falsche Positionsschätzung, zu reduzieren, wird der Suchraum 
immer weiter verkleinert, je länger die blind verfahrene Strecke s ist. Unter 
der Annahme, dass der Odometriefehler mit zunehmender Strecke s linear 
zunimmt, wird der Radius des Suchraums gemäß der folgenden Gleichung 


verkleinert: 
_ Je odo’ $ 
1000 


Neben der Eingrenzung des Suchraum durch die geschätzte Position wird 


(6.10) 


Todo = F 


die Wahrscheinlichkeit einer Verwechslung zusätzlich reduziert, indem wei- 
tere Parameter überprüft werden. Im Folgenden sind alle relevanten und zu- 


sätzlichen Eigenschaften aufgeführt: 


Position 

e Status 

e Geschwindigkeit 
e Richtung 

e Höhe 

e Umfang 

e Fläche 


Die Überprüfung basiert auf den in Kapitel 6.1 erarbeiteten Näherungs- 
funktionen. In einem ersten Schritt wird durch Einfügen der aktuell ge- 
messenen Objekteigenschaften in die dazugehörigen Näherungsfunktionen 


die Wahrscheinlichkeiten einer Übereinstimmung ermittelt. Im folgenden 
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Schritt werden die Ergebnisse werden gemäß Tabelle 6.4 gewichtet und zu 


einem Gesamtwert aufsummiert. 


Tabelle 6.4: Gewichtungstabelle der Positionsverfolgung. 


Priorität Geschw. Richtung Umfang max.Höhe Fläche 


Ergebnis 30 23 23 21 14 
Gewichtung 0,27 0,207 0,207 0,189 0,126 


Die Parameter Status und Position nehmen eine Sonderstellung ein. Ist das 
Objekt inventarisiert, wird es von der weiteren Untersuchung ausgeschlos- 
sen. Das selbe gilt für den Positionsabgleich mit der geschätzten Position. 
Liegt der zu untersuchende Mittelpunkt nicht im Suchfeld, gilt das Objekt 
als nicht gefunden. 

Ein Objekt gilt als wieder gefunden, wenn die Position des Mittelpunktes 
innerhalb des Suchraums liegt, es nicht inventarisiert ist und die Gesamt- 
wahrscheinlichkeit einen Wert von 0,95 ausweist bzw. mit 95%-tiger Wahr- 


scheinlichkeit im Konfidenzintervall liegt. 


6.4 Globale Lokalisierung 


Ziel der globalen Lokalisierung, auf englisch „global tracking“ ist, ein 
Objekt zu lokalisieren, dessen initiale Position nicht bekannt ist. Nach 
Thrun [30] ist dieses Problem deutlich schwieriger zu lösen, als die Po- 
sitionsverfolgung, da auf weniger Eigenschaften zurückgegriffen werden 
kann und das Risiko einer Verwechslungen deutlich größer ist. 

Basierend auf der bereits in Abschnitt 6.3 angewendeten Analyse der Ob- 
jekteigenschaften wird für jedes Objekt im System berechnet, mit welcher 
Wahrscheinlichkeit es sich um das gesuchte Objekt handelt. 


Die Eigenschaften, welche für die Analyse herangezogen werden, sind: 


e Status 


e Geschwindigkeit 
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e Umfang 
e Höhe 
e Fläche 


Da die initiale Position gänzlich unbekannt ist und nicht wie bei der Po- 
sitionsverfolgung auf eine ursprüngliche oder eine geschätzte Position zu- 
rückgegriffen werden kann, müssen alle Objekte gleichermaßen untersucht 
werden. Diese Untersuchung erfolgt auf Basis der im vorausgegangenen 
Abschnitt 6.3 verwendeten Näherungsfunktionen. Alle Eigenschaften wer- 
den mit deren Hilfe auf Übereinstimmungen mit dem gesuchten Objekt hin 
untersucht. Anschließend werden die Ergebnisse nach der in Tabelle 6.5 be- 
schriebenen Gewichtungen bewertet und aufsummiert. Das Ergebnis spie- 
gelt die Wahrscheinlichkeit wieder, mit der es sich um das gesuchte Objekt 
handelt. 


Tabelle 6.5: Gewichtungstabelle der Globalen Lokalisierung. 
Priorität Geschw. Umfang max.Höhe Fläche 
Ergebnis 30 23 21 14 
Gewichtung 0,34 0.26 0,24 0.16 


Der Status nimmt wieder eine Sonderrolle ein. Ein Objekt, welches als ,,in- 
ventarisiert‘“ geführt ist, kann nicht weiter verwendet werden und wird aus 
der Liste der möglichen Objekte entfernt. Des weiteren wird nach statischen 
Objekten gesucht. Ein Fahrzeug, das seine Position verloren hat, bleibt ste- 
hen, um nicht mit einem anderen Objekt zu kollidieren. Gesucht wird dem- 
zufolge nach Objekten, die aus Sicherheitsgründen still stehen. In Abbil- 
dung 6.9 sind die Ergebnisse der Wahrscheinlichkeitsberechnungen für je- 
des einzelne Objekt visualisiert. 

Bei genauer Betrachtung der Objekte in Abbildung 6.9 ist zu erkennen, dass 
sowohl das Objekt Nummer (4) als auch das Objekt Nummer (8) eine 100%- 


tige Übereinstimmung mit dem gesuchten Fahrzeug aufweisen. Eine eindeu- 
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[1] 42% 
[2] 36% 
[3] 33% [9] 50% 
[3] 100% 
[4] 100% 
[6] 0% 
[5] 40% [7] 65% 


Abbildung 6.9: Dargestellt im überwachten Bereich sind mehrere Objekte mit der Wahr- 
scheinlichkeit, dass es sich um ein FTF handelt. 


tige Zuordnung ist durch die Beobachtung eines einzelnen Zustandes nicht 
möglich. Eine Erweiterung der Methode ist notwendig. 

Dazu wird die die Grundidee der Markov-Lokalisierung übernommen. An- 
statt einen einzelnen Zustand zu beobachten, werden die Ergebnisse über 
einen längeren Zeitraum hinweg untersucht. 

Dies kann an folgendem Beispiel erläutert werden. Ein Objekt, welches sich 
im Laufe der Suche bereits bewegt hat, kann nicht mehr das gesuchte Fahr- 
zeug sein, da dieses seit Beginn der Suche stand. Somit kann das bewegte 
Objekt auch in Zukunft nicht das gesuchte Fahrzeug sein und wird auf Dauer 
ausgeschlossen. Diese Eigenschaft wird fortlaufend als „starre“ Eigenschaft 
bezeichnet. 

Anders verhält es sich mit den restlichen, den „weichen“ Eigenschaften wie 
Status, Höhe, Fläche und Umfang. Selbst wenn eine der weichen Eigen- 
schaften vollkommen aus dem Rahmen fällt, wird das zugehörige Objekt 
nicht aus der Liste der Kandidaten entfernt. Der Grund dafür ist der Situa- 
tion geschuldet, dass beispielsweise eine drastische Flächenänderung, eine 
Umfangsänderung oder eine Höhenänderung durch ein dicht vorbeifahren- 
des anderes Fahrzeug verursacht werden kann und vom Kamerasystem als 


ein zusammenhängendes Objekt erkannt wird. Um den Einfluss einer in Ab- 
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bildung 6.10(4) dargestellten kurzzeitigen Änderung zu reduzieren, wird die 
Gesamtwahrscheinlichkeit mit Hilfe der exponentiellen Glättung 1. Ord- 
nung geglättet (siehe Abschnitt 7.1.2). Da sich auch die Geschwindigkeit 
durch das kurzzeitige Verschmelzen zweier Objekte drastisch erhöhen kann, 
muss auch diese geglättet werden. Die Gewichtungsfaktoren & wurden je- 
weils auf 0,98 festgelegt um eine starke Glättung zu erhalten und da die 
Suche nicht zeitkritisch ist. Fällt die Wahrscheinlichkeit für die Geschwin- 
digkeit unter einen bestimmten Wert, wird das Objekt aus der Kandidaten- 


liste entfernt. 


[1] 42% 
[2] 36% 
[3] 33% [9] 50% 
ve [4] 24% 
[6] 0% 
[5] 40% [7] 65% 


Abbildung 6.10: Dargestellt ist die kurzfristige Verschmelzung zweier Fahrzeuge. 


Zusammenfassend kann gesagt werden, dass die globale Lokalisierung auf 
einem probabilistischen Verfahren beruht, welches über längere Zeit ange- 
wendet wird, um per Ausschlussverfahren das gesuchte Fahrzeug zu finden. 
Die dabei untersuchenden Eigenschaften können entweder starr oder weich 
sein. Die starre Eigenschaft „Geschwindigkeit“ kann ein Ausschlusskriteri- 
um sein. Wird ein Grenzwert der Geschwindigkeitswahrscheinlichkeit un- 
terschritten, kann mit großer Sicherheit gesagt werden, dass es sich bei dem 
untersuchten Objekt nicht um das gesuchte Fahrzeug handelt. Weiche Ei- 
genschaften führen auch zu einer Veränderung der Gesamtwahrscheinlich- 


keit, jedoch nicht zu einem Ausschluss des untersuchten Objektes. 


103 
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6.5 Kidnapped Robot Problem 


Das kidnapped Robot Problem ist das letzte und schwierigste Lokalisie- 
rungsproblem. Das Fahrzeug glaubt in diesem Fall zu wissen, wo es ist. 
Tatsächlich fand jedoch eine Verwechslung mit einem anderen Objekt statt. 
Auf Grund der Verwechslung und auf Basis einer falschen Position, gefähr- 
det das Fahrzeug sein Umfeld durch mögliche Kollisionen. Die Herausfor- 
derung besteht darin diese Fehler frühzeitig zu erkennen. 

Verhindert werden soll diese Situation mit Hilfe der vorgestellten Positions- 
verfolgung (siehe Abschnitt 6.3), während derer permanent die kinemati- 
schen als auch die geometrischen Eigenschaften überprüft werden. Darüber 
hinaus wird das Suchfeld durch die geschätzte Position möglichst stark ein- 
geschränkt, um andere Objekte von vorn herein auszuschließen. 

Trotzdem kann es auf Grund einer Verdeckung oder einer Störung dazu 
kommen, dass das Fahrzeug kurzzeitig rein odometrisch fährt. Die Wahr- 
scheinlichkeit, dass es zu einem Fehler kommt, ist in einer solchen Situa- 
tion am größten. Damit ein Fehler unentdeckt bleibt, müssen sowohl die 
kinematischen, als auch die geometrischen Eigenschaften zweier Fahrzeuge 
übereinstimmen. Das heißt sie müssen die selbe Form haben, als auch gleich 
schnell sein und in die selbe Richtung fahren. 

Da die Identifikation der Fahrzeug auf probabilistischen Ansätzen beruht, 
kann diese nicht zu 100% gewährleistet werden. Auch wenn eine Verwechs- 
lung höchst unwahrscheinlich ist, kann sie auch durch die kommunikations- 


gestützte Lokalisierung nicht ausgeschlossen werden. 


6.6 Zusammenfassung 


Im voraus gegangenen Kapitel wurden mit der Selbstidentifikation die Grund- 
lagen für eine erfolgreiche Lokalisierung gelegt. Aufbauend auf den in Ka- 
pitel 5 herausgearbeiteten Objekteigenschaften, wurden diese eingesetzt, um 


Methoden zur Lösung der drei großen Lokalisierungsprobleme vorzustellen, 
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die Positionsverfolgung, die globale Lokalisierung und des kidnapped Ro- 
bot Problems. Zuvor wurden die Eigenschaften einer gründlichen Analyse 
unterzogen, um deren Rauschverhalten zu studieren. Basierend auf der Häu- 
figkeit der Abweichungen, konnten Näherungsfunktionen ermittelt werden. 
Mit diesen kann eine Aussagen über die Wahrscheinlichkeit getroffen wer- 
den, in welchem Umfang die gemessenen Eigenschaften den des gesuchten 
Objektes entsprechen. Im Anschluss werden die resultierenden Eigenschaf- 
ten, basierend auf einer vorausgegangenen Nutzwertanalyse, gewichtet und 
zu einem Gesamtergebnis aufsummiert. Abhängig vom jeweiligen Lokali- 
sierungsproblem werden unterschiedliche Eigenschaften mit unterschiedli- 


chen Gewichtungen analysiert. 
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7 Funktionsdemonstration und 


Bewertung 


Die in dieser Dissertation vorgestell- 
ten Methoden werden im Folgenden 
anhand mehrerer Versuche demons- 
triert und die Ergebnisse bewertet. 
Geeignet für die Überprüfung kom- 
plexer Sachverhalte ist, nach Kaner et 
al. [20], der Einsatz von Testszenari- 
en, die auch aus mehreren Testfällen 
bestehen können. In diesem Kapitel 
wird die Positioniergenauigkeit des 
Systems anhand verschiedener Sze- 
narien getestet und bestimmt. Dafür 
werden einige Vorversuche durchge- 
führt und diskutiert. Zunächst werden 
die geometrischen und hardwarespe- 
zifischen Randbedingungen definiert 
(siehe Abschnitt 7.2.1) bevor im Ab- 
schnitt 7.2 auf den Aufbau der Ver- 
suche eingegangen wird. In Abschnitt 
7.3 werden die einzelnen Einflussfak- 


toren untersucht, die zu einer Verrin- 


Kamerasystem 


e 


Ladestation 


Versuchsfahrzeug 


Abbildung 7.1: Fotografie der Versuchsflä- 
che mit Versuchsfahrzeug 
und einer Sensoreinheit. 


gerung der maximal fahrbaren Geschwindigkeit und zu einer Gefährdung 


der Echtzeitfähigkeit führen können. Darüber hinaus spielt das Filtern pro- 
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zessrelevanter Größen, wie die Fahrzeugorientierung und die Geschwindig- 
keit, eine wichtige Rolle. Aus diesem Grund werden Versuche zur Bestim- 
mung der Filter und deren Faktoren durchgeführt und ausgewertet (siehe 
Abschnitt 7.4), um diese Größen möglichst genau bestimmen zu können. 
Die Ergebnisse dieser Vorversuche fließen in den letzten Abschnitt 7.5 ein, 
worin die Leistung des Gesamtsystems in Hinblick auf die Positionierge- 


nauigkeit untersucht und diskutiert wird. 


7.1 Methodenübersicht 


In der Arbeit wird für die Auswertung einiger Versuche auf etablierte, be- 
stehende Methoden zurückgegriffen. Diese werden im folgenden Unterka- 


pitel erläutert. 


7.1.1 Stichprobenumfang 


Neben den Versuchsergebnissen selbst, spielt auch die Menge an durchge- 
führten Versuchen eine wichtige Rolle, um ein aussagekräftiges Gesamter- 
gebnis zu erzielen. Die Qualität des Ergebnisses korreliert direkt mit der 
Anzahl an durchgeführten Versuchen. Um abschätzen zu können, wie hoch 
die Versuchsanzahl n sein sollte, kann auf die Formel für den Stichproben- 


umfang zurückgegriffen werden [17]: 


(7.1) 


Während n die minimale Anzahl an Versuchen beschreibt, die durchgeführt 
werden sollten, ergibt sich z aus dem Wert des angestrebten Konfidenzni- 
veaus der Standardnormalverteilung. Aus dem gängigen Konfidenzniveau 
von 95% ergibt sich z = 1,96. Die Standardabweichung wird durch o be- 
schrieben und e beschreibt die Fehlergrenze. 
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7.1.2 Exponentielle Glättung 1. Ordnung 


In diesem Abschnitt wird das Verfahren der exponentiellen Glättung 1. Ord- 
nung nach Schroeder et al. [28] beschrieben. Es dient als Grundlage für die 
meisten Glättungsverfahren, die bei der Auswertung der Daten verwendet 
wurden. 

Zur Berechnung des exponentiell geglätteten Mittelwertes so (x) wird wie 


folgt vorgegangen: 


sO (x) = a-m + (1—@)-S (x). (7.2) 


Wobei œ der Gattungsfaktor, x; der aktuelle Messwert und si) (x) das Er- 
gebnis der vorangegangenen Glättung ist. Das Ergebnis wird nicht allein 
durch den aktuellen Messwert bestimmt, sondern auch zu einem Anteil (1 — 
a) vom vorausgegangenen Ergebnis. Dieser Anteil wird durch den Glät- 
tungsfaktor & bestimmt. Wird der Glättungsfaktor zum Beispiel auf 0,1 fest- 
gelegt, hat das zur Folge, dass der aktuelle Messwert zu 10% und das alte 
Ergebnis zu 90% in das neue Ergebnis einfließt. Der Vorteil dieser Metho- 
de besteht darin, dass Ausreißer einen geringen Einfluss auf das Ergebnis 
haben. Ein Nachteil ist jedoch, dass tatsächliche Änderungen, so genannte 


Trends, erst nach einer gewissen Zeit erkannt werden. 


7.1.3 Exponentielle Glättung 2. Ordnung (nach Brown) 


Ein Vorteil der exponentiellen Glättung 2. Ordnung gegenüber der Glättung 
1. Ordnung ist, dass auf Trendänderungen schneller reagiert werden kann 
[28]. Um das zu ermöglichen, werden bei der Glättung 2. Ordnung die Er- 
gebnisse der exponentiellen Glättung 1. Ordnung nochmals geglättet. Als 
Resultat erhält man zwei Zwischenwerte, deren Differenz als Trendkorrek- 
tur dient. 

Begonnen wird mit der Berechnung des ersten Zwischenwertes s?) (x), ana- 


log der Berechnung der exponentiellen Glättung 1. Ordnung: 
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Sx) = om + (1— a) 8 (x). (7.3) 


Der 2. Zwischenwert wird folgendermaßen ermittelt (folgend als S; 2(x) be- 
zeichnet): 
2 2 
Sx) = a.-8 (x) + (1- a) -S (x). (7.4) 


In der ersten Periode sind der 1. und der 2. Zwischenwert st” (x) und s?) (x) 
identisch. Erst ab der 2. Periode weichen die beiden Werte voneinander 
ab. Beide Werte liegen auf einer Geraden, deren Steigung den Trend der 
Bedarfswerte kennzeichnet. Die Steigung wird deshalb folgendermaßen er- 


rechnet: 
b= Pw - $'(@)), 1.5) 
=Q 
wobei der Bruch er die Verzögerung darstellt, mit der die Vorhersage- 
werte der exponentiellen Glättung 1. Ordnung beim Auftreten von trendmä- 
igen Entwicklungen hinter der tatsächlichen Entwicklung zurückbleiben. 


Aus den beiden Zwischenwerten kann ein aktueller Trendwert a, bestimmt 


werden: 


a, = 2-8) (x) — 8 (x) . (7.6) 


Der Prognosewert xT;ı für den Zeitpunkt T folgt aus der Verknüpfung des 


aktuellen Trendwerts und der Steigung: 
XT+1 =A + br, (7.7) 


7.1.4 Bestimmtheitsmaß 


Das Bestimmtheitsmaß R?, ist ein statistisches Maß zur Qualifizierung der 
linearen Regression. Es ist ein Prozentsatz der Variation der Reaktionsva- 


riablen, die durch die angepasste Regressionslinie erklärt wird. Ist R? = 0, 
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bedeutet das, dass die eingepasste Linie keine der Variabilitäten der Ant- 
wortdaten um ihren Mittelwert herum erklärt. Ein R? von 1 wiederum be- 
deutet, dass die eingepasste Linie die gesamte Variabilität der Antwortdaten 
um ihren Mittelwert herum erklärt. Im Allgemeinen gilt: Je größer R?, desto 
besser passt die angepasste Gleichung zu ihren Daten. Das Bestimmtheits- 
maß wird durch folgende Gleichung beschrieben, wobei y; dem Messwert, 


y dem empirischen Mittelwert und y; dem Schätzwert entsprechen: 


EG -Y 


RAVi 
Loi-y) 


(7.8) 


7.1.5 Boxplot-Diagramm 


Boxplot-Diagramme dienen der grafischen Darstellung sowohl von Merk- 
malsausprägungen als auch von Extremwerten und Ausreißern [4]. Das Bei- 
spiel eines Boxplot-Diagramms ist in Abbildung 7.2 dargestellt. Dabei wird 
das Kernintervall, der Interquartilsabstand, vom unteren 25%-Quantil und 
oberen 75%-Quantil begrenzt ( [31], S. 35). Die Querlinie innerhalb des 
Interquartilsabstands charakterisiert den Median. Die Whiskers, wie die T- 
förmigen Antennen außerhalb der Box heißen, enden beim kleinsten oder 
größten beobachteten Wert, welcher noch nicht als Ausreißer eingestuft wird 
[31]. Ausreißer bezeichnen ‚alle beobachteten Merkmalswerte, die mehr als 
das 1,5-Fache des Interquartilsabstands, jedoch weniger als das 3-fache des 
Interquartilsabstands unterhalb des unteren bzw. oberhalb des oberen Quar- 
tils liegen“ ( [9], S. 117). 


7.2 Aufbau der Versuchsreihe 


Im folgenden Kapitel wird der Aufbau der Versuche erläutert. Dabei wird 


sowohl auf die Umgebungsbedingungen, genauer die Halle, in denen die 
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Maximum (Quartil 2 + 1,5 * IQR) 


Quartil 2 (75%) 
Interquartile Mittelwert 
Range (IQR) Medianlinie 

Quartil 1 (25%) 


Minimum (Quartil 1 - 1,5 * IQR) 


Ausreißer 


o00000 


Abbildung 7.2: Beispiel einer Boxplot-Darstellung. 


Versuche durchgeführt wurden eingegangen, als auch auf den Versuchsauf- 


bau und das verwendete Versuchsfahrzeug. 


7.2.1 Umgebungsbedingungen und Infrastruktur 


Folgend werden tabellarisch die Bedingungen aufgeführt, unter welchen die 
Versuche durchgeführt wurden. Sie sind unterteilt in Umgebungsbedingun- 
gen, die durch die zur Verfügung stehenden Räumlichkeiten entstehen, die 
infrastrukturellen Randbedingungen, welche die geometrischen Ausmaße 
des Versuchsaufbaus beschreiben, das verwendete Sensorsystem und das 


eingesetzte Kommunikationsprotokoll. 


7.2.2 Versuchsfahrzeug 


Für die Durchführung der Versuche wurde auf ein vorhandenes fahrerloses 
Transportfahrzeug (FTF) zurückgegriffen (siehe Abbildung 7.30(a)). Die 
Lokalisierungssoftware und die Regelungstechnik des FTS wurden an die 


kommunikationsgestützte Lokalisierung angepasst. 
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Tabelle 7.1: Umgebungsbedingungen, Infrastruktur und genutzte Komponenten für die Ver- 


suchsdurchführung. 
Umgebungsbedingungen 
f . Tageslicht mit stellenweise direkter Sonnenein- 
Lichtverhältnisse 
strahlung 
Grauer, leicht reflektierender Betonindustriehal- 
Hallenboden lenboden mit starken Gebrauchsspuren in Form 
von Kratzern, leichten Unebenheiten und Schmutz 
Infrastruktur 


Bodenabstand des Sensors 


Ca. 5, 78m 


Neigungswinkel des Sensors 


1,9° in x-Richtung und -3,4° in y-Richtung 
(siehe Abschnitt 4.1.3) 


Ca. 36m?, abzüglich fehlerbehafteter Rand- 


Überwachte Fläche 
bereiche in vertikaler Richtung 
Kamerasystem 
Tiefenbildkamera Kinect Version 2 von Microsoft [24] 
a Personal Computer mit einem Intel i7 Prozessor, 
Auswerteeinheit 
8 GByte RAM und Onboard-Grafikkarte 
Programmiersprache C# 
Kommunikation 
Netzwerk Intranet 


Kommunikatoinsprotokoll 


MQTT (siehe Abschnitt 5.4) 
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Eine Herausforderung stellt das Fahrverhalten des FTF durch den außermit- 
tigen Drehpunkt dar. In Abbildung 7.30(b) ist eine schematische Darstellung 
der Draufsicht des Versuchsfahrzeuges zu sehen. Dargestellt sind der Dreh- 
punkt, der alte und der neue Fahrzeugmittelpunkt, die Drehrichtung und die 
gemessene und die tatsächliche Orientierung. Zu erkennen ist, dass die tat- 
sächliche Orientierung nicht der Orientierung entspricht, welche sich aus 
den beiden Mittelpunktpositionen berechnen lässt, da das Heck des Fahr- 
zeuges bei einer Kurvenfahrt ausschert. Dieser Effekt ist um so größer, je 
enger der gefahrene Kurvenradius ist. Mit dem Ziel die kommunikationsge- 
stützte Lokalisierung unter erschwerten Bedingungen zu testen, wurde das 
Fahrzeug und dessen Fahrwerk dennoch für die Versuche ausgewählt. In Ta- 
belle 7.2 sind die geometrischen Parameter und relevante Komponenten des 
FTS aufgeführt. 


tatsächliche 


aktuelle Fahrzeugposition Orientierung 
m 


i ‘ii 
| mee er gemessene a 
=, ze LA Orientierung IN 
——e e e 


“TLIE 
” 


~~ Drehpunkt 


\LT Mittelpunkt 


alte Fahrzeug- 
position 


2 J i 


EA 
5 cm Drehrichtung 
(a) (b) 
Abbildung 7.3: (a) Bild des verwendeten Versuchsfahrzeugs [8] mit dessen geometrischen 


Maßen. (b) Skizzierte Darstellung des aus einer Kurvenfahrt resultierenden 
Orientierungsfehler, hervorgerufen durch den außermittigen Drehpunkt. 


7.2.3 Referenzmessverfahren 


Für die Untersuchung der Genauigkeit der Positionierung wird ein Refe- 


renzsystem benötigt, mit dem die exakte Position des Versuchsfahrzeuges 
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Tabelle 7.2: Geometrische Parameter und relevante Komponenten des Versuchs-FTS. 


Außenabmaße L = 600mm, B = 400mm, H = 340mm 


Oberflächenmaterial | Holz, rau und mit Höhenunterschieden 


Differenzialantrieb mit drehbar gelagerter Bockrolle 


Fahrwerk 
am Heck (siehe Abbildung 7.30 (a)) 
. Antriebsräder der Firma Blickle mit einem rutsch- 
Bereifung 
festen Belag und einer Belaghärte von 75° Shore A. 
Regler von Shulpa Gulati et al. [15] für besonders 
Fahrzeugregler 


runde Bewegungen 


Programmiersprache | C# 


an seiner Zielposition bestimmt werden kann. Zu diesem Zweck bietet sich 
das HTC Vive System des Unternehmens ,,High Tech Computer Corpora- 
tion (HTC)“ an, ein System zur Generierung einer virtuellen Realität. Es 
besteht aus einem Headset und zwei Controllern, die mit Hilfe zweier fest 
installierter Laseremitter, den so genannten Lighthouses, ihre Position im 
Raum millimetergenau ermitteln können [12]. 

Die Genauigkeit des Systems und dessen Anwendbarkeit wurden bereits 
von Niehorster et al. [23] untersucht. Sie konnten nachweisen, dass das 
Vive-Headset zwei große Probleme aufweist. Erstens sind Roll- und Nei- 
gungsmessungen, sowie Änderungen der Höhenmessungen stark fehlerbe- 
haftet. Der Grund dafür ist, dass das Vive System eine Referenzebene de- 
finiert, die nicht der tatsächlichen Bodenebene entspricht. Zweitens wird 
jedes Mal, wenn das Signal des Headsets verloren geht und die Tracking- 
Funktion wieder hergestellt wird, die Referenzebene geändert. 

Da Roll- und Neigungsmessungen bei den Positionierversuchen nicht durch- 


geführt werden und das Versuchsfahrzeug den Sichtbereich der Lighthouses 
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nicht verlässt, es also nicht zu einer Unterbrechung des Controllersignals 
kommt, konnte das Vive-System als Referenzsystem für die Positionierver- 
suche gewählt werden. 

Im Vorfeld der Versuche wurden eigene Genauigkeitsmessungen durch- 
geführt, in denen die Position nur eines Controllers ermittelt wurde. Zu 
diesem Zweck wurde dieser fest auf einer Kiste montiert, die durch einen 
Holzrahmen versteift wurde, um Verformungen zu verhindern. Der Control- 
ler befand sich dabei auf einer vergleichbaren Höhe, in der er auch auf dem 
Versuchsfahrzeug während der Positionierversuche installiert war. Damit ei- 
ne Aussage über die Güte der Positioniergenauigkeit des HTC Vive Systems 
getroffen werden kann, wurde die Kiste mit dem Controller wiederholt an 
mehreren vorher definierten Stellen platziert. Um sicher zu stellen, dass die 
Position an den jeweiligen Messpunkten unverändert bleibt, wurden zwei 
Stahlplatten L-förmig auf dem Boden platziert und als Anschlag verwendet 
(siehe Abbildung 7.4). 


Abbildung 7.4: Die Ermittlung der Positioniergenauigkeit der HTC Vive Controller erfolgte, 
indem ein auf einer Kiste fixierter Controller wiederholt an der selben Stelle 
platziert und die Position aufgezeichnet wurde. 
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Nach jeder erneuten Positionierung wurden die Koordinaten des Control- 
lers über 300 Messungen hinweg gemittelt und die resultierende Position 
aufgezeichnet. Abbildung 7.5 zeigt jeweils 15 ermittelte Positionen (grüne 


Punkte) des Controllers an 6 Zielpositionen in der Raumebene. 


x [m] 
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gE | 
I 
T æ 
S72 5 
-10-4 
-9 i 6 
= 1 
> 
-8 
-74 
4 
13 
64 


Abbildung 7.5: Die Ermittlung der Positioniergenauigkeit der HTC Vive Controller erfolgte, 
indem ein auf einer Kiste fixierter Controller wiederholt an vorher definierten 
Stellen platziert und die Position aufgezeichnet wurde. 


Die Ergebnisse der Versuche sind in Abbildung 7.6 in Form von Boxplot- 
Diagrammen dargestellt. Auf der horizontalen Achse sind die einzelnen Po- 
sitionen P1...6 aufgetragen, unterteilt in x- und y-Koordinaten. Auf der ver- 
tikalen Achse sind die Abweichungen in Millimetern vom Mittelwert al- 
ler ermittelten Werte pro Position aufgetragen. Die Genauigkeit unterliegt 
Schwankungen, die von der jeweiligen Position abhängen. Diese sind auf 
die schlechte Sichtbarkeit der Laseremitter zurück zu führen. Betrachtet 
man die Messungen der x- und y-Koordinaten getrennt voneinander, wei- 


sen 8 der 12 Messungen in 50% der Fälle eine Abweichung von unter 2mm 
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auf, 3 von unter 6 mm und eine Messung von unter 15 mm. 

Da die Abweichungen der Positionsbestimmung des Controllers in einem 
Bereich liegen, der deutlich unter den der erwarteten Positionierfehler des 
Versuchsfahrzeuges liegen, kann das Vive-System als Referenzsystem ein- 


gesetzt werden. 
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Abbildung 7.6: Boxplot-Diagramm der Positionsabweichungen des Vive- Controllers an 
sechs verschiedenen Positionen jeweils in x- und y-Richtung. 


7.3 Ermittlung der maximalen 
Fahrgeschwindigkeit 


Die mögliche maximale Fahrgeschwindigkeit hängt stark von der Latenz 
des Gesamtsystems ab. Sie spielt vor allem dann eine Rolle, wenn es um 
die Positionsbestimmung während der Fahrt geht. Ist die Gesamtlatenz be- 
kannt, kann damit berechnet werden, welche Geschwindigkeit ein Fahrzeug 
maximal erreichen darf, um innerhalb einer festgelegten Fehlertoleranz der 
Position zu bleiben. Als maximale Fehlertoleranz wurden in dieser Arbeit 


15cm angenommen. Dieser Wert ergibt sich aus der Fahrzeugbreite zuzüg- 
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lich einer Sicherheit von 5cm. Unterhalb der Fehlertoleranz kann eine Ver- 
wechslung zweier Fahrzeuge ausgeschlossen werden (siehe Abschnitt 6.3 in 
Kapitel 6). 

Die Gesamtlatenz setzt sich aus der Summe mehrerer spezifischer Einzel- 
latenzen zusammen. Diese entstehen durch die endliche Bildrate, die Dauer 
der Datenverarbeitung und der Datenübertragung und die Anwendung von 


Filtern für eine vorher definierte Positioniergüte. 


Bildrate 


Die Bildrate, mit der neue Daten zur Verarbeitung vom Sensor zur Verfü- 
gung gestellt werden, ist abhängig von der Leistung des verwendeten Sen- 
sors. Die im Testaufbau verwendete Tiefenbildkamera verfügt über eine 
Bildrate von maximal 30 Bildern in der Sekunde, die jedoch nur selten er- 
reicht wird und von der deshalb nicht ausgegangen werden kann. Aus die- 
sem Grund wurde untersucht, wie stabil die Bildrate ist und mit welcher 
Rate im weiteren Verlauf gerechnet werden kann. 

Auf Basis einer stichprobenartigen Untersuchung mit einer Anzahl von N = 
100 Datensätzen und einer vorläufigen Standardabweichung von o =0,04s, 
ergab sich durch die Verwendung der Methode des Stichprobenumfangs 
7.1.1 bei einem Konfidenzniveau von 95%, einem daraus resultierenden 
z = 1,96 und einer Fehlergrenze von 1/100s eine minimal benötigte Ver- 


suchsanzahl n von 


1,96? - 0,043? 
= 0,001? 


n 


> 7103 (7.9) 


Versuchen, um ein aussagekräftiges Ergebnis zu erhalten. Die Auswertung 


von 7500 Messdaten liefert folgendes Ergebnis: 


Aus dem Ergebnis geht hervor, dass die Bildrate im Durchschnitt mit 15,57 


Bildern in der Sekunde nur knapp über der Hälfte der maximal möglichen 
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Tabelle 7.3: Auswertungsergebnisse der Bildraten. 


Latenz Messwert 


Empir. Mittelwert 0,064 s 
Standardabweichung 0,034 s 
95% Perzentil 0,095 s 


Bildrate liegt. Darüber hinaus weist die hohe Standardabweichung auf starke 


Schwankungen hin. 


Datenverarbeitung 


Die Datenverarbeitung findet sequenziell auf zwei unterschiedlichen Gerä- 
ten statt, auf der Sensoreinheit und auf dem Fahrzeug. Die Zeit, die dafür 
benötigt wird, trägt zur Gesamtlatenz des Systems bei. Beim Sensorsystem 
ist es die Zeit, die vergeht, bis die Messwerte analysiert, die Objekte seg- 
mentiert, die Objekteigenschaften herausgearbeitet und alle Informationen 
zu einer Nachricht zusammengefasst sind. Auf dem Versuchsfahrzeug wird 
die Latenz durch die Zeit beschrieben, die vergeht, bis die Nachricht emp- 
fangen ist, die Eigenlokalisierung stattgefunden hat, die Wegplanung abge- 
schlossen ist und die Motoren angesteuert wurden. 

Eine Stichprobe der Datenverarbeitungsdauer des Sensors und des Fahr- 
zeuges mit einer Anzahl von jeweils N = 100 Messwerten bei einer vor- 
läufigen Standardabweichung von o = 0,0005s beim Sensorsystem und 
o = 0,00036s ergab bei einem Konfidenzniveau von 95%, einem daraus 
resultierenden z = 1,96 und einer Fehlergrenze von 0,0005 eine minimale 


Anzahl an durchzuführenden Versuchen sensor und zptF von 


1,96? - 0,005? 
NSensor = 9.00052 > 385 (7.10) 
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Tabelle 7.4: Auswertungsergebnisse der Datenverarbeitungszeiten. 


Latenz Sensoreinheit Fahrzeug 
empir. Mittelwert 0,037 s 0,000519 s 
Standardabweichung 0,0052 s 0,000465 s 
95% Perzentil 0,048 s 0,0011 s 


1 2, 2 
N 556), (7.11) 


"EZ 00012 = 


Die Analyse der Datenverarbeitungszeiten über 2700 Messwerte beim Sen- 
sorsystem und 1000 Messungen beim Fahrzeug mit einer variierenden An- 


zahl an Objekten im Sichtfeld der Kamera liefern die folgenden Ergebnisse: 


Datenübertragung 


Die Latenz, die aus der Datenübertragung resultiert, spiegelt die Dauer wie- 
der, die eine Nachricht ab dem Anfang des Versendevorgangs bis hin zum 
Empfang benötigt. Diese Zeit wird auch als Sendedauer bezeichnet. Damit 
eine exakte Messung durchgeführt werden kann, muss der Zeitmesser des 
Senders exakt mit dem des Empfängers synchronisiert sein. Da dies nur 
sehr schwierig zu bewerkstelligen ist, wurden zu Analysezwecken Sender 
und Empfänger, in zwei separaten Programmen, auf dem selben Rechner 
ausgeführt. Die Übertragung der Nachricht kann dadurch leicht von dem 
des realen Experiments abweichen. Während der Untersuchung war der 
Rechner über ein 2,4 GHz WLAN mit dem Netzwerk verbunden, um den 
ungünstigsten Fall abzudecken. Die Nachricht wurde per WLAN an einen 
Hotspot geschickt, von dort per LAN zum MQTT-Broker weitergeleitet, 
welcher die Nachrichten verwaltet. Von dort aus wurde sie zurück an den 
Hotspot und dann per WLAN an den Testrechner übermittelt. Am Test- 
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rechner wurde anschließend die Zeitdifferenz zwischen Senden und dem 
Empfangen ermittelt und aufgezeichnet. 
Mit dem Ziel ein aussagekräftiges Ergebnis zu erhalten, wurde wieder- 
um der Stichprobenumfang ermittelt, um die Mindestanzahl ngendedauer an 
durchzuführenden Versuchen zu ermitteln. Vorbereitend musste jedoch erst 
die durchschnittliche Nachrichtenlänge festgestellt werden. Um die Min- 
destversuchszahl nNachrichtenlänge ZU bestimmen wurde auch hier zu Beginn 
eine Stichprobe erhoben: 
2 2 

ANachrichtenlänge = = > 1695 (7.12) 

Das Ergebnis der Untersuchung von 1700 Messwerten ergab eine durch- 


schnittliche Nachrichtenlänge von 


durchschnittliche Nachrichtenlänge ~ 1450 (7.13) 


Zeichen. Auf Basis dieser Nachrichtenlänge konnte die durchschnittliche 
Sendedauer der Nachrichtenübertragung ermittelt werden. Die Untersu- 
chung des Stichprobenumfangs ergab eine Mindestversuchszahl von 
1,96? - 0,0073? 
ANachrichtenlänge = 0,002 > 199 (7.14) 
Die durchgefiihrten Tests erfolgten im internen Netzwerk des IFL. Die er- 


zielten Resultate nach 1000 Messungen sind in der folgenden Tabelle wie- 
dergegeben: 


Rauschunterdrückung 


Die Latenz, hervorgerufen durch die Rauschunterdrückung (siehe Abschnitt 
4.1.7), ist auch abhängig von der Sendedauer. Durch die bei der Rausch- 
unterdrückung gewählten Parameter für die Steigungsrate und die Erschei- 


nungsgrenze, muss ein Bildpunkt mindestens zweimal hintereinander als re- 
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Tabelle 7.5: Auswertungsergebnisse der Datenverarbeitungszeiten. 


Latenz Messwert 


empir. Mittelwert 0,0202 s 
Standardabweichung 0,0237 s 
95% Perzentil 0,0205 s 


Tabelle 7.6: Auswertungsergebnisse der Bildraten/Rauschunterdrueckung. 


Latenz Messwert 


Empir. Mittelwert 0,064 s 
Standardabweichung 0,034 s 
95% Perzentil 0,095 s 


levant eingestuft werden, damit er wahrgenommen wird. Aus diesem Grund 


entspricht die resultierende Latenz der Sendedauer: 


Latenzen auf einen Blick 


In der Tabelle 7.7 sind alle analysierten Latenzen inklusive der Gesamtlatenz 
aufgeführt. 

Auffällig ist, dass die Standardabweichungen größtenteils sehr groß ausfal- 
len und sich sogar in der Größenordnung der Mittelwerte befinden. Dadurch 
ist die daraus errechnete Maximalgeschwindigkeit nicht sehr aussagekräftig. 
Deshalb wurde als Gesamtverarbeitungszeit die Summe aller 95% Perzenti- 


le verwendet. Aus der errechneten Gesamtlatenz ergibt sich bei einem ma- 


ximal zulässigen Positionierfehler von +0,15m eine maximale Geschwin- 


digkeit v von 
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Tabelle 7.7: Mittelwert basierte Ergebnisse der analysierten Latenzen inklusive der Gesamtla- 
tenz. 


Latenz durch Zeit [s] emp. Stabw.[s] 95% Perzentil [s] 
1 / Bildrate 0,06421 0,0340 0,095 
Verarb.zeit Sensor 0,03706 0,0052 0,048 
Sendedauer 0,02018 0,0237 0,0205 
Verarb.zeit FTF 0,00052 0,0005 0,0011 
Rauschfilter 0,06421 0,0340 0,095 
Gesamtlatenz 0,186 0,097 0,260 
N 0,15m m 
= — = 0,577 — 7.15 
t 0,260 i s ( ) 


Mit dem Ziel, einen negativen Einfluss der Latenz auf die durchgefiihrten 
Positionierversuche zu vermeiden, wurde die Fahrzeuggeschwindigkeit in 


den folgenden Versuchen auf 0,2m/s gedrosselt. 


Diskussion 


Mit dem aktuell aufgebauten System können fahrerlose Transportfahrzeu- 
ge mit einer maximalen Geschwindigkeit von 0,577 m/s frei navigierend im 


überwachten Bereich fahren, ohne dass der durch die Latenz verursachte 


Positionierfehler größer als + 15cm wird. Aus den in Abbildung 7.7 darge- 
stellten einzelnen Latenzen geht hervor, dass die Bildrate und die Rausch- 
unterdrückung die größten Auswirkungen auf die Gesamtlatenz haben. 

Bei näherer Untersuchung der Entstehung der Gesamtlatenz fällt auf, dass 
die Datenverarbeitung im Durchschnitt mehr Zeit benötigt, als die minimale 
Schrittweite (1/Bildratemax) der Kinect zwischen zwei Bildern von 0,033. 
Das hat zur Folge, dass Messungen verworfen werden, da das System im- 


mer noch mit der Auswertung der alten Messwerte beschäftigt ist. Würde 
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man die Verarbeitungszeit des Sensorsystems auf unter 0,033 s reduzieren, 
könnte die maximale Bildrate ausgenutzt werden. Dies führte auch zu einer 
deutlichen Reduktion der Rauschfilterlatenz, da diese direkt mit der Bild- 
rate korreliert und zu einer deutlichen Erhöhung der maximal zulässigen 
Fahrzeuggeschwindigkeit. Bei gleichbleibend großen Zeiten der restlichen 
Latenzen ist alleine durch eine Reduktion der Sensorverarbeitungszeit auf 
unter 0,033s eine Verringerung der Gesamtlatenz auf 0,12s möglich, was 
zu einer theoretischen Maximalgeschwindigkeit von 1,24m/s führt. Neben 
der Optimierung des gesamten Sensordatenverarbeitungsprozesses biete ei- 
ne Überarbeitung des Segmentierungsalgorithmus Potential, da dieser ei- 
nen großen Teil der Verarbeitungszeit in Anspruch nimmt (siehe Abschnitt 
4.2.2). Darüber hinaus kann auch die Überarbeitung der Formabstraktion 
zu einer Reduktion der Verarbeitungszeit führen (siehe Abschnitt 5.3). Ob- 
wohl der Douglas-Peucker-Algorithmus nur sehr lokal eingesetzt wird, ist 
er dennoch rechenintensiv und könnte in Zukunft durch einen anderen Al- 


gorithmus oder eine andere Methode ersetzt werden. 


Datenverarbeitung FTF Rauschfilter 


0,0011 s 0,095 s 
1/Bildrate 
0,095 s 
Sendedauer 
0,0205 s Datenverarbeitung Sensor 


0,048 s 


Abbildung 7.7: Verhältnismäßige Darstellung aller Latenzen. 
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7.4 Ermittlung der Filtereinstellungen 


Die aktuelle und die vergangene Position des FTF und die daraus abgeleite- 
te Orientierung und die Objektgeschwindigkeit haben einen Einfluss auf die 
zukünftige Trajektorie, die das FTF abfährt und daher auf die endgültige Po- 
sitionsgüte, die es erreichen kann. Obwohl die Höhe keinen Einfluss auf die 
Positioniergenauigkeit hat, ist auch sie für den Transportprozess relevant. 
Bei der Ladungsträgerübergabe wird die Höhenbestimmung genutzt. 

Die vom Kamerasystem ermittelten Daten unterliegen Schwankungen, wel- 
che eine genaue Positionierung und Höhenbestimmung des FTF erschwe- 
ren. Im folgenden Kapitel werden die Fehler der Höhe, der Orientierung 
und der Geschwindigkeit des FTF mit Hilfe spezieller Versuche ermittelt, 


untersucht und Filtermethoden adaptiert, um diese zu minimieren. 


Die Ermittlung von Orientierung und Geschwindigkeit, abhängig von Stand- 
ortpositionen, wurde bereits vielfach in der GPS-Navigation untersucht, 
welche einige Parallelen zur hiesigen Problemstellung aufweist. So wurde 
2014 von Arijit Chowdhury et al. [5] eine Methode zur GPS-basierten Ge- 
schwindigkeitsermittlung veröffentlicht und im Jahre 2001 wurde eine Me- 
thode zur Orientierungsabschätzung von J.L. Marins et al. [22] publiziert. 
Trotz der ähnelnden Problemstellung gibt es dennoch zwei gravierende Un- 
terschiede. Bei der Orientierungsabschätzung wurden nicht ausschließlich 
die Standortdaten verwendet, sondern zusätzliche Informationen aus einer 
Inertialen Messeinheit (engl. inertial measurement unit, IMU). Diese zu- 
sätzlichen Informationen sind zusammengesetzt aus Kompass-, Drehraten- 
und Beschleunigungsdaten. Darüber hinaus wird davon ausgegangen, dass 
die untersuchten Objekte keine irreführende Richtungsbewegung ausführen, 
wie es beim verwendeten Versuchsfahrzeug der Fall ist (siehe Abschnitt 
7.2.2). Da diese irreführende Mittelpunktbewegung von der Geometrie und 
von den Fahreigenschaften abhängig sind und bei verschiedenen Fahrzeu- 


gen unterschiedlich ausgeprägt sein können, werden die Orientierung, die 
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Geschwindigkeit und die Höhe individuell aus den vom Kamerasystem 


übermittelten Daten abgeleitet und auf dem Fahrzeug selbst gefiltert. 


7.4.1 Datenerhebung 


Eine Datenbasis für die Untersuchung der prozessrelevanten Eigenschaf- 
ten wurde gebildet, indem das Versuchsfahrzeug mit einer konstanten Ge- 
schwindigkeit von 0,2 m/s bestimmte, vorgegebene Trajektorien abgefahren 
ist und währenddessen die Daten des Kamerasystems als auch die odometri- 
schen Daten des Fahrzeuges aufgezeichnet wurden. Je nach Untersuchung 
wurde auf den Datensatz dreier unterschiedlicher Trajektorien zurückgegrif- 


fen. So fuhr das Fahrzeug im Falle der 


e Trajektorie 1 eine Strecke in Form einer 8 ab, 

e Trajektorie 2 bestand überwiegend aus Abschnitten in Form von Ge- 
raden und 

e Trajektorie 3 bestand überwiegend aus Halbkreisförmigen Abschnit- 


ten. 


Auf die Zuordnung der Trajektorien zu den jeweiligen Eigenschaften wird 
in den nachfolgenden Kapiteln detailliert eingegangen. Die Daten wurden 


auf Basis der in Kapitel 7.2 beschriebenen Randbedingungen aufgezeichnet. 


Trajektorie 1: Mit dieser Trajektorie, soll ein möglichst großes Spek- 
trum an Bereichen und Richtungen abgebildet werden. Dafür wurde eine 
8-förmige Trajektorie gewählt, welche zu möglichst geringen Odometrie- 
fehlern führt. In Abbildung 7.8 sind die aufgezeichneten Positionsdaten des 
Kamerasystems in den Koordinaten der Kamera dargestellt. Zu Erkennen ist 
die 8-förmige Spur, die mehrfach hintereinander abgefahren wurde. Mit Hil- 
fe der Trajektorie 1 konnten Daten sowohl aus dem Zentrum der überwach- 


ten Fläche, als auch aus den Randbereichen aufgezeichnet werden. Darüber 
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hinaus wurden unterschiedliche Kurven verschiedener Radien und Richtun- 
gen, als auch gerade Streckenabschnitte abgefahren. Bei einer konstanten 
Geschwindigkeit von 0,2m/s wurden mehr als 32.000 Positionsmessungen 
durchgeführt und aufgezeichnet. 
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Abbildung 7.8: Trajektorie 1. Detektierte Fahrstrecke des Versuchsfahrzeuges, dargestellt in 
den Koordinaten der Kamera. Das Fahrzeug fuhr eine Trajektorie in Form 
einer liegenden Acht ab, die übermittelten Daten des Kamerasystems wurden 
aufgezeichnet und anschließend analysiert. 


In Abbildung 7.8 ist zu erkennen, dass die Fahrzeugtrajektorie trotz vorge- 
gebener Strecke von Runde zu Runde variieren kann. Das liegt daran, dass 
dem Fahrzeug die Spur in Form einzelner Wegpunkte vorgegeben wurde 
und die Wegplanung zwischen den einzelnen Punkten vom Fahrzeug selbst 
vorgenommen wird. Je nach Positionsfehler und Orientierung führt dies zu 


unterschiedlichen Verbindungsstrecken zwischen den Wegpunkten. 


Trajektorie 2: Im Fall der Trajektorie 2 wurde das konstante Geradeaus- 
fahren untersucht. Zwischen geraden Strecken wurde die Ausrichtung des 


Fahrzeuges mehrfach verändert, wodurch das Fahrzug in unterschiedliche 
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Richtungen und Bereiche fuhr (siehe Abbildung 7.9). Im Unterschied zu 
Trajektorie 1 wurden die Geschwindigkeiten der beiden Antriebsräder zu 
Beginn einer jeden Geradeausfahrt fixiert, so dass es zu keinen Ausgleichs- 
bewegungen oder Richtungskorrekturen mehr kam. Abweichungen von der 
Geraden kamen nur noch durch Odometriefehler zu Stande. 
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Abbildung 7.9: Trajektorie 3. Darstellung der Fahrstrecke des Versuchsfahrzeuges im Koor- 
dinatensystem der Kamera. Das Fahrzeug fuhr mehrere gerade Streckenab- 
schnitte ab, unterbrochen von Kurven zur Richtungsänderung. 


Trajektorie 3: Ziel war es, mit Hilfe der Trajektorie 3 den Odometrie- 
fehler des Fahrzeugs zu ermitteln. Zu diesem Zweck wurden zwei lange 
gerade Streckenabschnitte abgefahren die durch Kurven zu einem Rundkurs 
verbunden waren, Abbildung 7.10. Im Idealfall, ohne Störeinflüsse, würden 
sich die Orientierungen der Geraden, resultierend aus den Daten des Kame- 
rasystems, auch über eine unendliche Zeitspanne hinweg nicht ändern, sie 
wären identisch mit den Daten der Odometrie. In der Realität wirken sich je- 
doch Störungen negativ auf die odometrisch ermittelte Orientierung aus. Die 
Ursachen für Störungen werden u.a. durch Schlupf der Reifen, Ungenauig- 


keiten der Positionsgeber in den Motoren und, fabrikations- und verschleiß- 
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bedingt, unterschiedlich große Reifendurchmesser hervorgerufen. Dies führt 
dazu, dass die Orientierung bei jeder Messung von der tatsächlichen Orien- 
tierung abweicht. Es kommt zu einer Fehlerfortpflanzung, die den Orientie- 
rungsfehler über die Zeit stetig größer werden lässt. Durch den Vergleich 
der Orientierungen in den einzelnen Runden, welche mit Hilfe der Versuche 
ermittelt wurden, konnte kaum eine Abweichung festgestellt werden. Die 
Ergebnisse der Untersuchung, sind in Kapitel 7.17 wiedergegeben. 
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Abbildung 7.10: Trajektorie 3. Darstellung der Fahrstrecke des Versuchsfahrzeuges im Koor- 
dinatensystem der Kamera. Das Fahrzeug fuhr einen Rundkurs ab, gestreckt 
durch gerade Streckenabschnitten. 


7.4.2 Analyse und Glättung der Fahrzeughöhe 


Alle Eigenschaften, darunter auch die Höhe, unterliegen Schwankungen, 
siehe Kapitels 7.4. Obwohl die tatsächliche Höhe des Fahrzeuges im Laufe 
der Versuche konstant blieb, weichen die durch das Kamerasystem ermittel- 
ten maximalen Höhen von den tatsächlichen Höhen ab. Ziel ist es einerseits 
mit Hilfe eines Filters diese Schwankungen zu reduzieren und andererseits 


die durch einen Filter hervorgerufenen Latenzen möglichst gering zu halten. 
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In Abbildung 7.11 sind die verschiedenen Höhenmessungen den Positionen 


des Fahrzeuges zugewiesen. 


Abbildung 7.11: Darstellung der Ermittelten maximalen Fahrzeughöhen in Abhängigkeit zur 
Fahrzeugposition. Abweichungen der gemessenen Höhe zur tatsächlichen 
Höhe treten hauptsächlich in zwei Bereichen auf. 


Zu sehen ist die zurückgelegte Strecke in Form der Trajektorie 1 (siehe Ab- 
bildung 7.8) und starke, teilweise regelmäßig auftretende Schwankungen, 
welche die tatsächliche Höhe von ca. 360 mm um ein Vielfaches überschrei- 
ten. 

Einer der Bereiche mit großen Abweichungen von der tatsächlichen Fahr- 
zeughöhe befindet sich in der unteren linken Ecke des überwachten Be- 
reichs, siehe Abbildung 7.11. Dies kann dadurch gegründet werden, dass 
zur Zeit der Versuchsaufzeichnung exakt an dieser Stelle die Sonne direkt 


auf den Boden schien und die hohe Sonneneinstrahlung zu einer deutlichen 
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Abbildung 7.12: Darstellung der Ermittelten Fahrzeughöhen über die gesamte Versuchsreihe. 
Die graue Kurve beschreibt die unveränderten Messwerte, die blaue Kurve 
die bereinigten und die rote Kurve die bereinigten Messwerte nach anschlie- 
Bender Glättung. 


Verfälschung des Messwerte geführt hat. Der zweite Bereich mit großen 
Schwankungen liegt im Randgebiet des Sensorsichtfeldes. Im Randbereich 
sind die Messwerte stark rauschbehaftet (siehe Abschnitt 4.1.4), was wie- 
derum zu starken Verfälschungen der Höhenmesswerte führt. Es hat sich 
herausgestellt, dass diese Fehler von so großem Ausmaß sind, dass sie mit 
einfachen Glättungsmethoden nicht eliminiert werden können. Aus diesem 
Grund werden sie als Ausnahmen betrachtet und aus dem Datensatz ent- 
fernt. In Abbildung 7.12 sind die ursprünglichen Messwerte in grau darge- 
stellt, die bereinigten in blau und die gefilterten in rot. 


Ziel ist es, die bereinigten Messwerte so zu filtern, dass eine Veränderung 
der tatsächlichen Fahrzeughöhe möglichst schnell und sicher erkannt, ohne 
dass diese mit Rauschen verwechselt wird. Ein Beispiel für eine solche Hö- 
henänderung ist die Aufnahme eines Ladungsguts. 

Zum Einsatz kommt eine exponentielle Glättung 1. Ordnung (siehe Ab- 


schnitt 7.1.2), da die Höhe des Fahrzeuges im Vergleich zur Abtastrate über 
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längere Zeiträume konstant bleibt. Andererseits führt eine exponentielle 
Glättung 1. Ordnung zu einer verzögerten Anpassung bei einer tatsächli- 
chen Höhenänderung. Findet auf Grund eines aufgenommenen Ladungsträ- 
gers eine reale Änderung der Fahrzeughöhe statt, sollte diese zeitnah erkannt 


werden. 


Einflussfaktoren 

Einige Faktoren haben einen Einfluss auf die Güte der Höhenbestimmung. 
Zur diesen gehören die Höhe des Objektes, die Reaktionszeit, die Art der 
Glättung, der Glättungsfaktor und der Schwellwert. 

Da eine exponentielle Glättung 1. Ordnung verwendet wird, kann über die 
Sprungantwort auf die Reaktionszeit geschlossen werden. Diese ist abhän- 
gig von der Stärke der Änderung, dem Schwellwert und dem Glättungsfak- 
tor und kann gemäß Abbildung 7.13 dargestellt werden. Dargestellt ist der 
Verlauf der Sprunghöhe über die Anzahl an Messungen für drei verschiede- 
ne Glättungsfaktoren 0,9, 0,95 und 0,98. Die drei gestrichelten Linien geben 
drei Schwellwerte an und entsprechen 50%, 80% und 95% der Zielhöhe. 
Sobald ein festgelegter Schwellwert überschritten wird, wird davon ausge- 
gangen, dass die Höhenänderung durch ein Objekt verursacht wurde und 
nicht durch Rauschen. Aus Abbildung 7.13 geht hervor, dass die Reaktions- 
zeit sowohl vom Glättungsfaktor, als auch von der Höhe des Schwellwertes 
abhängt. Je niedriger der Schwellwert, desto schneller wird dieser erreicht 
und desto kürzer ist die Reaktionszeit. Andererseits steigt jedoch die Wahr- 
scheinlichkeit, dass der Schwellwert durch Rauschen erreicht wird was zu 
Fehlinterpretationen führt. Ähnlich verhält es sich mit dem Glättungsfaktor. 
Je kleiner der Faktor, desto steiler die Sprungantwort und desto schneller 
wird der Schwellwert erreicht. Dennoch werden die Messwerte bei einem 


niedrigen Glättungsfaktor schwächer geglättet, sodass durch Rauschen her- 
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Abbildung 7.13: Sprungantwort über die Anzahl an Messungen für drei verschiedenen Glät- 
tungsfaktoren. 


vorgerufene „Ausreißer“ einen größeren Einfluss haben und weniger stark 
unterdrückt werden. 

Die Festlegung der einzelnen Einflussparameter erfolgt, indem die Reak- 
tionszeit festgelegt wird, in der eine gegebene Änderung der Objekthöhe 
erkannt werden muss. Auf Basis der Exhaustionsmethode werden die Para- 
meter Reaktionszeit, Objekthöhe, Schwellwert und Glättungsfaktor in vor- 
gegebenen Schritten variiert, bis alle möglichen Kombinationen ausprobiert 
und untersucht sind. Nach jeder neuen Kombination wird die Häufigkeits- 
verteilung der Abweichungen berechnet und als Maß für die Güte einge- 
setzt. Gesucht und gespeichert wird die Parameterkombination eines jeden 
Zeitschritts, welche bei einer Eintrittswahrscheinlichkeit von 99,9% die ge- 
ringste Abweichung aufweist. 


Die einzelnen Parameter, deren Iterationsintervalle und Schrittweiten sind 
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in Tabelle 7.8 angegeben. Ein kleiner Auszug aus der Ergebnissammlung 
der Parametersuche mit den Parametern: Reaktionszeit (RZ) maximale Ob- 
jekthöhe (Obj), Schwellwert (SWW), Glättungsfaktor (œ) und Eintritts- 
wahrscheinlichkeit (ETM) ist in Tabelle 7.9 dargestellt. 


Tabelle 7.8: Parameter und Schrittweiten, welche bei der Exhaustionsmethode für die Höhen- 
analyse durchlaufen werden. 


Parameter Intervall Schrittgröße 


Reaktionszeit [0,0; 12,25] 0,25 
Objekthöhe [0; 500] 1 
Schwellwert [0,0; 0,99] 0,01 
Glattungsfaktor [0,0; 0,99] 0,001 


Auf der Grundlage der Ergebnissammlung können anschließend die Ob- 
jekthöhen für spezifische Eintrittswahrscheinlichkeiten approximiert wer- 
den. Um zum Beispiel die Objekthöhenänderung bei einer 99,9%-tigen Ein- 
trittswahrscheinlichkeit zu berechnen, werden aus der Tabelle die beiden 
Bereiche gewählt, die knapp unterhalb und knapp oberhalb der gewünsch- 
ten Eintrittswahrscheinlichkeit liegen. Im Falle des Beispieles sind dies die 
Zeilen 8 und 9. Mit Hilfe des Dreisatzes kann anschließend die Höhenände- 
rung berechnet werden. 

Das Ergebnis der Auswertung für unterschiedliche Eintrittswahrscheinlich- 
keiten ist in Abbildung 7.14 dargestellt. Abhängig von der Reaktionszeit 
und der gewählten Wahrscheinlichkeit kann die Mindesthöhe eines Objek- 


tes bestimmt werden. 
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Der Glättungsfaktor & und der Schwellwert in Abhängigkeit von der Ein- 
trittswahrscheinlichkeit und der Reaktionszeit können den Abbildungen 
7.15 (a) und 7.15 (b) entnommen werden. 

Die erforderlichen Parameter können nun von den drei Abbildungen 7.14, 
7.15 abgelesen werden. Um eine einfachere Bestimmung der Parameter zu 
erhalten, werden die Zusammenhänge folgend mit Näherungsfunktionen be- 
schrieben. Es muss jedoch beachtet werden, dass die Parameter nur appro- 
ximiert sind, wodurch es zu einer Vergrößerung des Fehlers kommen kann. 


Die folgende Exponentialfunktion beschreibt den Zusammenhang zwischen 


Tabelle 7.9: Auszug aus dem durch Variation der Einflussparametern erhobenen Datensatz 
bestehend aus Reaktionszeit (RZ), maximaler Objekthöhe (Ob jH), Schwellwert 
(SWW), Glättungsfaktor (œ) und Eintrittswahrscheinlichkeit (ETM). 


Zeile RZ[s] ObjH[mm] SWW[%] a ETW [%] 


1 0,1926 123 0,99 0,2154 99,8311 
2 0,1926 124 0,99 0,2154 99,8427 
3 0,1926 125 0,99 0,2154 99,8569 
4 0,1926 126 0,99 0,2154 99,8569 
5 0,1926 127 0,99 0,2154 99,8597 
6 0,1926 128 0,99 0,2154 99,8740 
T 0,1926 129 0,99 0,2154 99,8826 
8 0,1926 130 0,99 0,2154 99,8912 
9 0,1926 131 0,99 0,2154 99,9027 
10 0,1926 132 0,98 0,2714 99,9141 
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Abbildung 7.14: Darstellung des Zusammenhangs der minimalen Objekthöhenänderung und 
der Reaktionszeit für unterschiedliche Eintrittswahrscheinlichkeiten. 


1,04 1,00 4 
0,84 0,95 - 
2 g 
= z 
£06, E020 | 
(0) 5 
(e 
044 0,85 - 
0,24 0,80 4 
f 1 r T i T T 1 T r T T T T 7 1 
0 2 4 6 8 10 12 14 0 2 4 6 8 10 12 14 
Reaktionszeit [s] Reaktionszeit [s] 
(a) bl (b) is 


Abbildung 7.15: Abhängigkeit des Glättungsfaktors (a) und des Schwellwertes (b) von der 
Reaktionszeit für unterschiedliche Eintrittswahrscheinlichkeiten. 


der Reaktionszeit und der Objekthöhe bei einer Eintrittswahrscheinlichkeit 
von 99,99%: 


YObjHoche = 43,5 exp ( 


41 7.1 
T exp( 755p) + ‚656 (7.16) 
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Bestimmtheitsmaß: 0,99987 


Der Zusammenhang zwischen der Reaktionszeit und dem Glättungsfak- 
tor bei einer Eintrittswahrscheinlichkeit von 99,99% wird durch folgende 


Wachstumsfunktion beschrieben: 


YGlaettung = 0,99 + Tl x \1,5288 (7.17) 
6 


Bestimmtheitsmaß: 0,99848 


Abschließend kann mit Hilfe einer Faltungsfunktion der Zusammenhang 


zwischen der Reaktionszeit und dem Schwellwert abgeschätzt werden: 


x+0,746 
Yschwellwerr = 1,492 — 0,7159 - exp (0,5 - 0,0000493 — 72,196 I 
00 lak 
a 1,414 


Bestimmtheitsmaß: 0,85926 


Versuchsparameter 

Bevor für die anstehenden Positionierversuche die Parameter festgelegt wer- 
den können, muss die Reaktionszeit definiert werden, von der alle Parameter 
abhängig sind. Diese wurde durch eine Videoanalyse abgeschätzt. Das Ver- 
suchsfahrzeug aus dem Forschungsprojekt „Objektschutz“ kann mit Hilfe 
eines Bandförderers und einer Übergabestelle Kleinladungsträger aufneh- 
men [16]. Dieser Prozess der Ladungsübergabe dauert ca. 1,5 Sekunden. 
Ziel ist es, den Ladungsträger noch während des Transports zu erkennen, 
sodass das Fahrzeug ohne weitere zeitliche Verluste losfahren kann. Aus 
diesem Grund wurde die Reaktionszeit auf 1,5 Sekunden festgelegt, woraus 


sich die folgenden Parameter ableiten lassen: 
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e Reaktionszeit = 1,5s 

e Eintrittswahrscheinlichkeit = 99,99% 

e Glättungsfaktor = 0,9281 

e Mindesthöhe = 98,25mm 

e Schwellwert = 82% der Mindesthöhe 


7.4.3 Analyse und Glattung der Fahrzeugorientierung 


Für Positionierung und Navigation spielt die Orientierung eine bedeuten- 
de Rolle. Im folgenden Kapitel wird die Orientierung, die aus den vom 
Kamerasystem übermittelten Mittelpunktpositionen berechnet wird, unter- 
sucht, gefiltert und bewertet. Nachfolgend wird sie Mittelpunktorientierung 
genannt. Ziel ist es, auf Basis dieser Mittelpunktpositionen möglichst präzi- 
se die tatsächliche Orientierung abzuleiten. 

Damit eine Aussage über die Güte der ermittelten Orientierung gefällt wer- 
den kann, wird eine Referenzorientierung gewählt, mit der sie verglichen 
wird. Als Referenz wurde die Orientierung gewählt, die sich aus den Odo- 
metriedaten ableiten lässt. In den folgenden Abschnitten wird zu Beginn die 
Güte der Referenzorientierung untersucht, um anschließend in zwei unter- 
schiedlichen Fällen die Mittelpunktorientierung einmal während einer Kur- 
venfahrt und während einer Geradeausfahrt zu filtern. Das Bestimmtheits- 
maßes bzw. die empirischen Standardabweichung werden als Größe für den 
Vergleich der beiden Orientierungen herangezogen. Dabei wird die Mittel- 


punktorientierung von den folgenden Faktoren beeinflusst: 


e die Vektorlänge, 

e Reaktionszeit, 

e die Art der Glättung und 
e der Glattungsfaktor. 
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Referenzorientierung 


Als Referenzorientierung wurden die Orientierungen gewählt, die sich aus 
den Odometriedaten des Versuchsfahrzeuges ableiten lassen. Die odome- 
trisch ermittelten Richtungsvektoren ergeben sich aus den Motordrehzahlen. 
Diese werden 50 mal in der Sekunde erfasst und ausgewertet. Zeitgleich mit 
dem Empfang der Kameramittelpunkte wird die resultierende Orientierung 
aus den Odometriedaten aufgezeichnet. Diese Resultierende setzt sich aus 
den Daten der aktuellen Messung und denen der letzten Messung zusam- 
men. Ziel ist es, die Präzision der Odometrieorientierung zu ermitteln und 
heraus zu finden ob sie als Referenzmaß für die Mittelpunktorientierung 


geeignet ist. 


Zum Abschätzen des Odometriefehlers wurde im Vorfeld, auf Basis der Tra- 
jektorie 3 7.10, ein Versuch durchgeführt. Über sechs Iterationen hinweg 
wurden Rundkurse gefahren und nach jeder Umrundung die vom Fahrzeug 
geschätzte Odometrieorientierung aufgezeichnet. Erwartet wurde, dass die- 
se von Runde zu Runde immer stärker von der tatsächlichen Orientierung 
abweicht und dadurch ein Fehlerfortpflanzung zu erkennen ist. 

In Abbildung 7.16 sind die Mittelpunktpositionen des Kamerasystems de- 
nen der Odometrie gegenüber gestellt. Um eine möglichst gute Aussage 
über die tatsächliche Orientierung nach jeder Runde treffen zu können, wur- 
den gerade Streckenabschnitte in die Trajektorie eingebaut. Diese geraden 
Streckenabschnitte kamen zu Stande, indem das Versuchsfahrzeug ab einer 
definierten Stelle die Geschwindigkeit beider Antriebsräder gleichgesetzt 
und über mehrere Meter hinweg fixiert hat. 

Die tatsächliche Orientierung wird mit Hilfe dieser geraden Streckenab- 
schnitte angenähert, indem die Mittelpunktpositionen extrahiert werden. 
Die geraden Streckenabschnitte sind in Abbildung 7.16 (a) jeweils rot ein- 
gefärbt. Die geraden Streckenabschnitte bestehen im Mittel aus 291,3 Po- 
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Abbildung 7.16: Vergleich der Fahrzeugpositionen generiert aus den Mittelpunktkoordinaten 
(a) und den Odometriedaten (b). Die Odometriedaten weisen einen starken 
Offset auf, der durch den sich fortpflanzenden Odometriefehler entsteht. 


sitionen bei einer empirischen Standardabweichung von 3,3 Positionen. Da 
die Positionen verrauscht sein können, werden jeweils die ersten 20 bzw. die 
letzten 20 Positionen gemittelt. Der Richtungsvektor wird anschließend aus 
den gemittelten Positionen berechnet und in ein Winkelmaß überführt. Auf 
die selbe Art werden auch die Odometrieorientierungen auf den geraden 


Streckenabschnitten ermittelt. 


Ergebnis 

Der Vergleich der beiden Orientierungen hat das folgende Ergebnis gelie- 
fert, siehe Abbildung 7.17. Die roten Punkte stellen die Winkel dar, welche 
auf Basis der Mittelpunktpositionen des Kamerasystems errechnet wurden. 
Die blauen Punkte stehen für die Odometrieorientierungen und die grauen 
Punkte repräsentieren die Differenz zwischen den beiden Orientierungen. 


Aus den Ergebnissen geht hervor, dass der odometrische Winkelfehler im 


141 


7 Funktionsdemonstration und Bewertung 


Schnitt bei [0,34]° schwankt und ein Trend nicht eindeutig zu erkennen ist. 
Aus diesem Grund wird der odometrische Winkelfehler nicht aus dem Trend 
heraus bestimmt, sondern aus der maximalen Abweichung, die aufgetreten 
ist. Dieser Fehler beträgt 0,56° Grad/Runde und wird fortwährend im wei- 
teren Verlauf der Arbeit berücksichtigt. 
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Abbildung 7.17: Fahrzeugpositionen aus den Odometriedaten generiert 


Orientierungsfilter-Kurvenfahrten 

Mit Hilfe des charakterisierten Referenzsystems soll nun ein Verfahren ent- 
wickelt werden, mit dem aus den kamerabasierten Mittelpunktpositionen 
eine möglichst genaue Orientierung abgeleitet werden kann. Zu diesem 
Zweck wurden parallel sowohl Mittelpunktpositionen, als auch Odome- 
triedaten aufgezeichnet, während das Versuchsfahrzeug die Trajektorie 1 
abfuhr (siehe Abbildung 7.8). Auf Basis der erhobenen Daten wurde eine 
Methode entwickelt, die eine möglichst hohe Übereinstimmung der abgelei- 
teten kamerabasierten Daten mit denen des Referenzsystems hervorbringt. 


In Abbildung 7.18 sind die aus den Mittelpunkten und Odometriedaten er- 
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mittelten Orientierungen des Fahrzeugs in der Ebene in Grad des gesamten 
Versuchsdurchlaufs aufgetragen. Die rote Linie beschreibt die Orientierung 
aus den Odometriedaten, die graue Linie im Hintergrund die Orientierung 
auf Basis der Mittelpunkte ohne Glättung und mit einer Vektorlänge von 13 
Bildpunkten. Ein Maß für die Übereinstimmung stellt das Bestimmtheits- 
maß dar, welches die Deckungsgleichheit der beiden Kurven in Prozent 
wiedergibt. 

Aus den Messwerten heraus ist zu erkennen, dass die Referenzorientie- 
rung (rote Linie) eine deutlich gleichmäßigere Form aufweist im Vergleich 
zur Mittelpunktorientierung (graue Linie). Bei genauer Betrachtung tritt ein 
starkes Abweichen der Mittelpunktorientierung von der Referenzorientie- 
rung in regelmäßigen Abständen und in Form kurzer, lokaler Ausbrüche auf. 
Diese Ausbrüche sind auf das Fahrverhalten zurück zu führen, verursacht 
durch die Art des Fahrwerks des Versuchsfahrzeuges (siehe Abschnitt 7.30 
(b)). Bei jeder Richtungsänderung schwenkt das Fahrzeug auf Grund des 
außer mittigen Drehpunkte aus, wodurch sich die Mittelpunktposition ent- 
gegen der tatsächlichen Orientierung verschiebt und so zu einer fehlerhaften 
Orientierung führt. Dieser Effekt wird größer, je kleiner der Kurvenradius 
des Fahrzeuges ist. 

Eine möglichst guten Übereinstimmung zwischen Mittelpunkt- und Refe- 
renzsystem kann erreicht werden, indem die zu Beginn des Kapitels bereits 
beschriebenen Einflussfaktoren wie die Vektorlänge und die Reaktionszeit, 
als auch die Art der Filters und dessen Glättungsfaktoren angepasst werden. 
Zunächst wurde ein Filter definiert, der auftretende Schwankungen, hervor- 
gerufen durch das Fahrwerk, herausfiltert, bzw. glättet. Da es sich bei der 
Orientierung um einen Wert handelt, der sich oft ändern kann, ist die ex- 
ponentielle Glättung 2. Ordnung auf Grund der schnelleren Reaktion und 
der Berücksichtigung von Trends von Vorteil (siehe Abschnitt 7.1.3). Ande- 
rerseits treten auf Grund der Fahrzeugfahrwerkes systematische Fehler auf, 


die vom Filter als Trend missinterpretiert werden könnten, weshalb auch die 
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Abbildung 7.18: Darstellung der Orientierungen in Grad über eine bestimmte Anzahl an Mes- 
sungen. Die rot Linie beschreibt die Orientierungen, welche aus den Odo- 
metriedaten abgeleitet wurden, die graue Linie die aus den Mittelpunkten 
abgeleitete Orientierung und die blau die geglättete Mittelpunktorientierung. 


exponentielle Glättung 1. Ordnung (siehe Abschnitt 7.1.2) in Frage kommt 
und aus diesem Grund hier mit der exponentiellen Glättung 2. Ordnung ver- 
glichen wird. 


Zur Anpassung an die tatsächliche Orientierung, wurde die Exhaustions- 
methode angewendet. Dabei wurden die Einflussfaktoren variiert und die 


Schrittgrößen wie in Tabelle 7.10 folgt festgelegt. 


Tabelle 7.10: Parameter und Schrittweiten, welche bei der Exhaustionsmethode für die Orien- 
tierungsanalyse durchlaufen werden. 


Parameter Intervall Schrittgröße 
Glättungsart [exp. Glättung 1. und 2. Ordnung] 

Reaktionszeit [s] [0; 5] 0,1 
Vektorlänge [Bilder] [0; 70] 1 
Glättungsfaktor [0,0; 0,99] 0,01 
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Analog zur Höhenfilterung wurde jede Kombination auf ihre Güte hin unter- 
sucht. Als Gütekriterium wurde das Bestimmtheitsmaß herangezogen. An- 
schließend wurde für jeden Zeitschritt die Parameterkombination gespei- 


chert, die zur größten Übereinstimmung führte. 
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Abbildung 7.19: Eine längere Glättung der aus den Sensordaten ermittelten Orientierung führt 
zu kleineren Fehlern, aber auch zu einer größeren Latenz. Diese Latenz kann 
durch die odometrisch ermittelte Orientierung korrigiert werden. Der durch 
Fehlerfortpflanzung entstehende odometrische Fehler ist auf kurze Distanzen 
vernachlässigbar. 


Da auf Basis des Bestimmtheitsmaßes keine Aussage über den maximalen 
Fehler bei einer bestimmten Eintrittswahrscheinlichkeit getroffen werden 
kann, wird jedes einzelne Ergebnis einer weiteren, genaueren Untersuchung 
unterzogen, indem für jede der Kombinationen eine Häufigkeitsverteilung 
der auftretenden Abweichungen durchgeführt wird. Am Beispiel der fol- 
genden Parameterkombination ist in Abbildung 7.19 eine solche Verteilung 
dargestellt. Angewendet wurden die exponentielle Glättung 1. Ordnung, ei- 
ne Reaktionszeit von ca. 1 s, eine Vektorlänge von 16 Bildern und ein Glät- 


tungsfaktor von 0,52. Auf Basis dieser Verteilungen können die maximal 
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auftretenden Fehler für bestimmte Eintrittswahrscheinlichkeiten berechnet 
werden. Die maximalen Orientierungsfehler für die Eintrittswahrscheinlich- 
keiten 99%, 99,5% und 99,9% sind in Abhängigkeit von der Reaktionszeit 
in Abbildung 7.20 wiedergegeben. Berechnet wurde sie sowohl für eine 
exponentielle Glättung 1. (durchgezogene Linie) als auch 2. Ordnung (ge- 


strichelte Linie). 
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Abbildung 7.20: Darstellung des Verhältnisses zwischen Orientierungsfehler und Reaktions- 
zeit nach einer exponentiellen Glättung 1.Ordnung (durchgezogen) und einer 
exp. Glättung 2.Ordnung (gestrichelt) für die Eintrittswahrscheinlichkeiten 
99%, 99,5% und 99,9% (von unten nach oben). 


Zwischenergebnis - Die in Grad angegebenen maximalen Abweichungen 
sind über die Reaktionszeit aufgetragen (siehe Abbildung 7.20). Generell zu 
erkennen ist ein kleiner werdender Fehler bei zunehmender Reaktionszeit. 
Grund dafür ist, dass bei längerer Reaktionszeit und damit größerem Zeitin- 
tervall die Glättung verstärkt werden kann, was zu einer besseren Überein- 
stimmung der Mittelpunktsorientierung mit der odometrischen Orientierung 


führt. Die gestrichelten Linien beschreiben die Fehler bei einer exponentiel- 
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len Glättung 2. Ordnung, während die durchgezogenen Linien für die Fehler 
einer exponentiellen Glättung 1. Ordnung stehen. Da die Fehler für die exp. 
Glättung 1. Ordnung bei gleicher Reaktionszeit fast durchweg kleiner oder 
gleich der, der exp. Glättung 2. Ordnung sind, wird im weiteren Verlauf die 
Glättung 1. Ordnung gewählt. Der Unterschied kann damit erklärt werden, 
dass das ausscherende Heck des Versuchsfahrzeuges eine Verschiebung des 
Mittelpunkts verursacht und mit einem Trend in der Richtungsänderung ver- 
wechselt wird (siehe Abschnitt 7.2.2). Trotz einer Verringerung des Fehlers 
ist dieser auch bei einer großen Reaktionszeit nur für eine grobe Navigation 
geeignet, nicht jedoch für eine präzise Positionierung. Mit dem Ziel den 


Fehler zu reduzieren wurde ein weitere Ansatz implementiert. 


Orientierungsfilter-Geradeausfahrten 

Der Fehler der Mittelpunktorientierung, wird größtenteils durch den außer- 
mittigen Drehpunkt des Fahrwerks hervorgerufen und tritt vor allem bei 
Richtungsänderungen und damit beim Kurvenfahren auf. Bewegt sich das 
Fahrzeug auf einer Geraden, kommt es nicht zum Ausschwenken, wodurch 
der Fehler deutlich geringer ausfallen sollte. 

Die Orientierugsgüte beim Geradeausfahren wurde weitgehend analog zu 
der beim Kurvenfahren untersucht. Dabei wurde anstatt Trajektorie 1 Tra- 
jektorie 2 abgefahren, welche aus einigen geraden Streckenabschnitten be- 
steht 


Bei der Datenanalyse wurden nur die geraden Wegstrecken analysiert. Die 
Qualität des Orientierungsvektors wurde beim Geradeausfahren, im Gegen- 
satz zum Kurvenfahren, durch die Standardabweichung bestimmt. Es wurde 
in Kauf genommen, dass der Vergleich der Standardabweichungen bei der 
Ermittlung der Orientierungsparameter während der Geradeausfahrt nicht 


zu einem optimalen Ergebnis führt, da diese an den Mittelwert angelehnt ist 
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Abbildung 7.21: Darstellung des Verhältnisses zwischen Orientierungsfehler und Reaktions- 
zeit nach einer exponentiellen Glättung 1.Ordnung für die Eintrittswahr- 
scheinlichkeiten 99%, 99,5% und 99,9%. 


und nicht an der exakten Orientierung. Die Berechnung der besten Werte 
erfolgte wiederum analog mit Hilfe der Exhaustionsmethode und die maxi- 
malen Orientierungsfehler wurden mit Hilfe der Häufigkeitsverteilung für 
die Eintrittswahrscheinlichkeiten 99%, 99,5% und 99,9% ermittelt. Alle 
Einflussfaktoren wurden bis auf die Art der Glättung analog variiert, Tabel- 
le 7.10. Da es auf der Geradeausfahrt im Idealfall zu keiner Änderung der 
Richtung und somit zu keiner Trendänderung kommt, wurde ausschließlich 


die exponentielle Glättung 1. Ordnung zur Filterung der Werte untersucht. 


Zwischenergebnis - Es konnte bestätigt werden, dass beim Geradeaus- 
fahren im Vergleich zum Kurvenfahren deutlich bessere Orientierungsgü- 
ten erreicht werden können (siehe Abbildung 7.24). Jede dargestellte Linie 
basiert auf der exponentiellen Glättung 1. Ordnung. Die oberen drei Li- 
nien repräsentieren die bereits vorgestellten Orientierungsfehler bei einer 


Kurvenfahrt während die unteren, schmalen Linien die Fehler bei der Ge- 
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radeausfahrt beschreiben. Mit zunehmender Reaktionszeit fällt der Fehler 
zu Beginn erst stark und flacht dann asymptotisch immer weiter gegen Null 
ab. Bereits nach 2s liegt in 99% der Fälle der Fehler der Orientierung fürs 
Geradeausfahren bei unter 8° während er bei der Kurvenfahrt noch bei un- 
gefähr 28° liegt. Die Vektorlänge und die dazugehörigen Glättungsfaktoren 
sind in den Abbildungen 7.22 und 7.23 über die Reaktionszeit, in Form 
der grauen Kurve, aufgetragen. Die Parameter um die Filter einzustellen, 
können aus den Diagrammen entnommen werden, abhängig von der Reak- 
tionszeit. Die folgenden Näherungsfunktionen dienen als Hilfestellung. Bei 
der Verwendung dieser, muss jedoch berücksichtigt werden, dass die Ergeb- 
nisse fehlerbehaftet sind. Anhand der jeweiligen Bestimmtheitsmaße kann 


die Übereinstimmung, bzw. Abweichung abgeschätzt werden. 


Vektorlänge [Bilder] 


10 T T T T T ieee ot 1 
05 0,0 0,5 1,0 1,5 2,0 2,5 3,0 3,5 


Reaktionszeit [Sekunden] 


Abbildung 7.22: Darstellung des Verhältnisses zwischen Vektorlänge und Reaktionszeit. 


Die jeweiligen Orientierungsfehler über die Reaktionszeit auf kurviger Stre- 
cke können mit Hilfe der folgenden Polynominalfunktionen näherungsweise 


beschrieben werden: 
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Abbildung 7.23: Darstellung des Verhältnisses zwischen Glättungsfaktors und Reaktionszeit. 


y99% Kurve = 58,357 — 9,659 - x — 1,7964 - x? + 0,4369 : x? (7.19) 


Bestimmtheitsmaß: 0,99807 


99,5% Kurve = 51,667 — 10,36 -x — 0,5618 - x? +0,2368-x° (7.20) 
Bestimmtheitsmaß: 0,99785 


99,9% Kurve = 48,706 — 10,787 -x — 0,114- x? +0, 179 -x° (1.21) 


Bestimmtheitsmaß: 0,99835 


Die Orientierungsfehler über die Reaktionszeit auf gerade Strecke können 


durch folgende Exponentialfunktionen angenähert werden: 
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Y99%,Gerade = 29,34 - exP( 7353 BE ) +3,901 (7.22) 
Bestimmtheitsmaß: 0,98169 
Y99,5%,Gerade = 29,229 - exP(5 ogi sei )+3,55 (7.23) 
Bestimmtheitsmaß: 0,99286 
=x 
Y99,9%,Gerade = 30,023 explo 38193) +3,438 (7.24) 


Bestimmtheitsmaß: 0,9946 


Kombinierter Orientierungsfilter 

In den vorausgegangenen Abschnitten wurden jeweils sowohl die optima- 
len Parameterkombinationen für Kurvenfahrten, als auch speziell angepass- 
te Parameterkombinationen für Geradeausfahrten berechnet. Um in der je- 
weiligen Situation die richtige Parameterkombination zu wählen, wird vor- 
ausgesetzt, dass diese geändert wird, abhängig davon, ob das Versuchsfahr- 
zeug zum aktuellen Zeitpunkt eine Kurve oder geradeaus fährt. 

Da der Wechsel zwischen den Filtern schwierig sein kann, wird im fol- 
genden Abschnitt untersucht, wie groß die Auswirkungen auf die Orien- 
tierungsgüte sind, werden bei der Geradeausfahrt nicht die passenden Para- 
meter verwendet, sondern die Kurvenparameter beibehalten. 

Ein Nachteil entsteht dadurch, dass die Vektorlänge bei Kurvenfahrten, auch 
bei einer kurzen Reaktionszeit, schon bei einem hohen Wert beginnen, ver- 
glichen mit der speziell angepassten Vektorlänge bei einer Geradeausfahrt. 
Aus diesem Grund ist eine Reaktionszeit von unter 1,156 Sekunden beim 
Geradeausfahren nicht möglich (siehe Abbildung 7.24, dicke Linien rechts 
des grauen Balkens). Bei größeren Reaktionszeiten sind die Fehler zwar 
immer größer oder gleich der Fehler, welche auf den speziellen Parame- 


tern fürs Geradeausfahren basieren, bewegen sich aber dennoch in einem 
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ähnlichen Bereich. Werden keine Reaktionszeiten von unter 1,156 Sekun- 
den benötigt, ist eine Änderung der Parameter beim Geradeausfahren nicht 
notwendig. Die resultierende Kurve, welche den Zusammenhang zwischen 
Reaktionszeit und Vektorlänge 7.25 beschreibt, kann durch die folgende Po- 


lynominalfunktion angenähert werden. 


yyL = 14,2274— 1,1478 -x— 1,4563 -x7 +4,2302-x° — 0,8057 -xt (7.25) 


Bestimmtheitsmaß: 0,99898 
Der Zusammenhang zwischen Glättungsfaktor und Reaktionszeit 7.26 kann 


durch die folgende Exponentialfunktion beschrieben werden. 


yor = —1,9646E — 6 -exp ( +0,50645 (1.26) 


I) 
0,27523 
Bestimmtheitsmaß: 0,73808 


Zusammenfassung 

Zusammenfassend kann gesagt werden, dass die Art des gewählten Fahr- 
werks des Versuchsfahrzeuges bei Kurvenfahrten einen großen negativen 
Einfluss auf die Qualität der ermittelten Orientierung hat. Dieser fällt so 
groß aus, dass die resultierende Orientierung nur für eine grobe Richtungs- 
bestimmung ausreicht. Auf gerader Strecke hat das Fahrwerk keinen er- 
kennbaren Einfluss, sodass die resultierenden Orientierungen auch für eine 
Orientierungskorrektur eingesetzt werden können. Es muss jedoch berück- 
sichtigt werden, dass eine Latenz von mindestens 1,156 Sekunden in Kauf 
genommen werden muss. Für schnellere Reaktionszeiten, müssen die Para- 


meter speziell für geraden Strecken angepasst werden. 
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Fehler [°] 
& 
L 
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Reaktionszeit [Sek.] 


Abbildung 7.24: Darstellung der Verhältnisse zwischen Orientierungsfehler und Reaktionszeit 
für die Eintrittswahrscheinlichkeiten 99%, 99,5% und 99,9% bei Kurven- 
fahrten (obere drei Kurven) und Geradeausfahrten (untere drei Kurven). 

Die breiteren Kurven rechts der Abgrenzung stellen die Fehler dar, unter 
Verwendung der Kurvenfahrtparameter. 


7.4.4 Analyse und Glättung der Fahrzeuggeschwindigkeit 


Als letzte der drei Eigenschaften wurde die Fahrzeuggeschwindigkeit unter- 
sucht und gefiltert. Analog zur Orientierung und der Höhe werden auch hier 
zu Beginn die Einflussfaktoren festgelegt. Sie setzten sich aus den selben 


Faktoren wie auch die Orientierung zusammen: 


die Vektorlänge, 

e Reaktionszeit, 

e Art der Glättung und 
e der Glättungsfaktor. 


Die Geschwindigkeit wird ermittelt, indem eine zurückgelegte Strecke durch 


die dazu benötigte Zeit dividiert wird. Da sich das Fahrzeug meistens mit 
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einer konstanten Geschwindigkeit bewegt und gemäß der Orientierung ein 
Ausscheren beim Kurvenfahren zu einem falschen Trend führt (siehe Ab- 
schnitt 7.4.3), wird analog als Filter die exponentielle Glättung 1. Ordnung 
verwendet. Als Datengrundlage für die Analyse dienen die Mittelpunktpo- 


sitionen, welche während des Abfahren der Trajektorie 1 ermittelt wurden. 


290 


280 
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Abbildung 7.25: Darstellung eines Ausschnitts aus den aufgezeichneten Mittelpunktpositio- 
nen, während der Fahrt des Versuchsfahrzeuges. Es ist zu erkennen, dass die 
Mittelpunktposition in einigen Fällen „zurück“ springt, obwohl das Fahrzeug 
mit konstanter Geschwindigkeit gefahren ist. 


Gründe, weshalb eine Glättung der Geschwindigkeitswerte über mehrere 
Bilder hinweg von Vorteil ist, sind neben den Verfälschungen durch das 
Fahrwerk auch ein Rauschen der Mittelpunktpositionen. In Abbildung 7.25 
ist ein Ausschnitt der ermittelten Positionen dargestellt. Die Bildrate der Ka- 
mera war konstant und das Fahrzeug fuhr mit konstanter Geschwindigkeit. 
Es ist zu erkennen, dass die Entfernungen zwischen zwei Positionen stark 
schwanken können, die Positionen sogar entgegen der Fahrtrichtung wieder 
„zurückspringen“ können. Ein Betrachten über mehrere Bilder kann dieses 


Positionsrauschen herausmitteln. Auch hier gilt jedoch: Je länger gemittelt 
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wird, desto genauer das Ergebnis, aber auch desto länger die Reaktions- 
zeit. Im Folgenden wird analog zur Orientierungsanalyse ein Kompromiss 
zwischen Güte und Reaktionszeit ermittelt und der Filter dementsprechend 
angepasst. 

Mit Hilfe der Exhaustionsmethode werden die in Tabelle 7.11 aufgeführ- 
ten Parameter in den angegebenen Wertebereichen und Schrittweiten ite- 
rativ durchlaufen, um für unterschiedliche Reaktionszeiten die beste Kom- 
bination zu finden, die sich aus der Suche nach der kleinsten empirischen 


Standardabweichung ergibt. 


Tabelle 7.11: Parameter und Schrittweiten, welche bei der Exhaustionsmethode für die Ge- 
schwindigkeitsanalyse durchlaufen werden. 


Parameter Intervall Schrittgröße 
Glättungsart [exp. Glättung 1. Ordnung] 

Reaktionszeit [s] [0; 5] 0,1 
Vektorlänge [Bilder] [0; 70] 1 
Glättungsfaktor [0,0; 0,99] 0,01 


Aus der Optimierung kann geschlossen werden, dass die Vektorlänge einen 
größeren Einfluss auf die Güte der Geschwindigkeitsbestimmung hat, als 
der Glättungsfaktor. Während abhängig von der Reaktionszeit die Vektor- 
länge beinahe konstant den größtmöglichen Wert annimmt, schwankt der 
Glättungsfaktor bis zu einer Reaktionszeit von 5 Sekunden zwischen den 
Werten & = 0,05 und 0,22. Um die Anwendung zu vereinfachen, wurden 
der Einfluss des Glättungsfaktors untersucht, indem sowohl variable und 
gleichbleibende Glättungsfaktoren, als auch der Verzicht auf eine Glättung, 
auf Basis der empirischen Standardabweichung, verglichen wurden. Der 
konstante Glättungsfaktor wurde auf œ = 0,05 festgesetzt, da dieser zu kei- 
ner Erhöhung der Reaktionszeit führt. Das Ergebnis des Vergleichs ist in 
Abbildung 7.26 dargestellt. Die Verläufe der wechselnden und konstanten 
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Faktoren sind im Rahmen der Auflösung deckungsgleich, (schwarze Linie), 
während die Standardabweichungen ohne Filter (graue Linie) bei gleicher 


Reaktionszeit höher ausfallen. 


20 


emp. Standardabweichung [%] 


T T T T 
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Abbildung 7.26: Resultierende Standardabweichungen bei angepasstem und konstanten Glät- 
tungsfaktor (schwarz) und bei fehlendem Glättungsfaktor (hellgrau). Die 
Ergebnisse der angepassten und der konstanten Glättungsfaktoren sind an- 
nähernd deckungsgleich, weshalb sie von einer einzelnen Linie repräsentiert 
werden. 


Anschließend wurden für die jeweiligen Reaktionszeiten Häufigkeitsvertei- 
lungen erstellt und die maximalen Fehler für die Eintrittswahrscheinlichkei- 
ten 99%, 99,5% und 99,9% berechnet. 


Zusammenfassung 

In Abbildung 7.27 sind die Fehler der ermittelten Geschwindigkeiten über 
die Reaktionszeit aufgetragen. Je mehr Zeit für die Glättung zur Verfügung 
steht, desto mehr Bilder können ausgewertet werden und desto mehr mit- 
telt sich die Streuung der Geschwindigkeit heraus. Bei höherer Geschwin- 
digkeit verringert sich die Wahrscheinlichkeit, dass es zu „Rücksprüngen“ 
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(siehe Abbildung 7.25) kommt. Die jeweiligen Geschwindigkeitsfehler bei 
unterschiedlichen Eintrittswahrscheinlichkeiten können mit Hilfe einer Ex- 
ponentialfunktion annähernd beschrieben werden. Die Funktionen und de- 
ren Übereinstimmungen in Form des Bestimmtheitsmaßes werden wie folgt 


bestimmt: 


= 0,21344. 2381 2T 
yoom = 0,213 leer Zum) +00 38 (7.27) 
Bestimmtheitsmaß: 0,9946 
—x 
= 0,24794. — 2551 72 
Y99,5% = 0,2479 ex (779387) 790 55 (7.28) 
Bestimmtheitsmaß: 0,99795 
= 0,48227- = 4 72 
Y99,9% = 0,48 mA F393) +00 59 (7.29) 


Bestimmtheitsmaß: 0,9838 


Abhängig von der Reaktionszeit ändert sich die Vektorlänge linear (siehe 
Abbildung 7.4.4) und kann durch die folgende lineare Gleichung beschrie- 


ben werden: 


yr = 14,645 -x + 0,0794 (7.30) 


Bestimmtheitsmaß: 0,9979 


7.5 Versuche zur Ermittlung der Positioniergüte 


Nachdem im letzten Kapitel (7.4) alle Randbedingungen definiert und alle 


Parameter bestimmt wurden, wird in diesem Kapitel ein Versuch beschrie- 
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Abbildung 7.27: Darstellung des Zusammenhangs zwischen dem Geschwindigkeitsfehler 
und der Reaktionszeit für die Eintrittswahrscheinlichkeiten (von unten nach 
oben) 99%, 99,5%, 99,9% 


ben, mit dem die Positioniergüte des Gesamtsystems ermittelt wird. Dabei 
stehen dem Fahrzeug ausschließlich die Informationen der kommunikati- 
onsgestützten Lokalisierung zur Verfügung. Beginnend mit der Erläuterung 
des Testszenarios (7.5.1) wird im Anschluss auf die Datenerhebung und die 
Versuchsdurchführung eingegangen (7.5.2). Abschließend werden die Er- 
gebnisse interpretiert und diskutiert (7.5.3). 


7.5.1 Aufbau des Testszenarios 


Der Aufbau des Testszenarios hat einen großen Einfluss auf die Aussage- 
kraft der Versuchsergebnisse. Je nachdem welche Position das Fahrzeug in- 
nerhalb des überwachten Bereichs bzw. des Testfeldes anfahren soll, ist mit 
unterschiedlichen Güten zu rechnen. Auf Grund der abnehmenden Qualität 
der Kameradaten in den Randbereichen kann es dort zu einer Verschlech- 
terung der Positionsgüte und der Zielorientierung kommen. Als Zielposi- 


tionen wurden 6 repräsentative Orte innerhalb des überwachten Bereichs 
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Vektorlänge [pix] 
> 
oO 


0 4 2 3 4 5 
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Abbildung 7.28: Darstellung des Zusammenhangs zwischen dem Vektorlänge und der Reakti- 
onszeit. 


gewählt, die ein großes Spektrum dieser Gütevariationen abdecken. Gemäß 
Abbildung 7.29 befindet sich eine Position im Zentrum des Testfeldes (1), 
zwei in der horizontalen Mitte im oberen (6) und unteren (2) Bereich, eine in 
der vertikalen Mitte im Randbereich (4) und zwei in den rechten Ecken des 
Testfeldes (3), (5). Darüber hinaus positioniert sich das Fahrzeug auf jeder 
der Positionen mit einer anderen Zielorientierung, gekennzeichnet jeweils 
durch einen Pfeil. Auf Zielpositionen auf der linken Seite der Testfeldes 
kann aus Symmetriegründen verzichtet werden. 

Um die Güte der Position zu validieren, wurde die Position mit Hilfe ei- 
nes Controllers des VR-Systems Vive von HTC gemessen (siehe Abschnitt 
7.2.3). Zu Beginn der Messungen wurde der Controller exakt im Mittel- 
punkt des Fahrzeuges positioniert. Eine Fotografie des Aufbaus ist in Abbil- 
dung 7.30 zu sehen. Zu erkennen ist die Holzoberfläche des Fahrzeuges in 
dessen Zentrum eine weiße Box mit einem schwarzen Controller platziert 


wurde. Das Zentrum der kreisförmigen Aussparung des Controllers liegt 
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Abbildung 7.29: Versuchsaufbau für die Feinpositionierung mit Anfahrpunkten an unter- 
schiedlichen Stellen im überwachten Bereich. Die Pfeile markieren die je- 
weilige Zielausrichtung. 


über dem Mittelpunkt der Holzfläche. Der Laserscanner (schwarz-gelb) hat 
keinen Einfluss auf die Positionierung und dient lediglich dem Kollisions- 


schutz. 


Abbildung 7.30: Versuchsfahrzeug mit Holzoberfläche und mittig positioniertem Controller 
der HTC Vive. 
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Die Ermittlung der Zielpositionsgüte erfolgte, indem die Position des Con- 
trollers 300 Mal aufgezeichnet, die Ergebnisse gemittelt und abgespeichert 
wurden. Darüber hinaus wurden auch die Mittelpunktpositionen des Kame- 
rasystems aufgezeichnet. Die für die Positionierung relevanten Filter wur- 


den wie in Tabelle 7.12 aufgeführt gewählt. 


7.5.2 Versuchsablauf 


Das Fahrzeug startete die Versuchsreihe von Punkt 1 aus, indem es dort 
händisch platziert wurde (siehe Abbildung 7.29). Nachdem die erste Ziel- 
position zufallsgesteuert ermittelt wurde, berechnete das Fahrzeug die Tra- 
jektorie zum Zielpunkt. Auf dem Weg zum Ziel wurde kontinuierlich die 
verbleibende Distanz berechnet. Ab einer Entfernung zum Zielpunkt von 
ca. einem Meter, wird eine neue Trajektorie berechnen, mit deren Hilfe das 
Fahrzeug den Zielpunkt rein odometrisch erreicht ohne dass die Fahrzeug- 
position oder Orientierung mit Hilfe der Kameradaten aktualisiert werden. 
Das ist unter anderem deshalb notwendig, weil das Fahrzeug beim Anfahren 
einer Übergabestelle automatisch versuchen würde, dieser auszuweichen. 
Mit Hilfe der Trajektorie wird das Fahrzeug gezwungen, nahe an eine Über- 
gabestelle heran zu fahren. Die Positionierung wird abgeschlossen, indem 
am Zielpunkt angekommen, die Orientierung korrigiert und die Position des 
Controllers aufgezeichnet wird. Anschließend beginnt der Prozess von neu- 


em mit der Auslosung der nächsten Zielposition. Eine Fehlerfortpflanzung 


Tabelle 7.12: Unterschiedliche Filter und deren Parameter für die Positionierung. 


Parameter Orientierungsfilter Geschwindigkeitsfilter 
Reaktionszeit [s] 2 2 
Vektorlänge [Bilder] 27 30 
Glättungsfaktor 0,51 0,05 


161 


7 Funktionsdemonstration und Bewertung 


der Orientierung wird vermieden, indem diese immer dann aktualisiert wird, 
sobald das Fahrzeug länger als 2 Sekunden geradeaus fährt. 

Die Wegplanung erfolgt auf Basis des A*-Algorithmus. Um die Rechen- 
zeit zu verkürzen, die zur Berechnung der Route benötigt wird, wurde die 
Auflösung der Knoten auf 256x412 Punkte reduziert. Die implementierte 
Fahrzeugregelung fußt auf einer Veröffentlichung von Gulati aus dem Jahre 
2008 [15]. 
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Abbildung 7.31: Darstellung der mittleren Controllerpositionen fiir jede Positionsmessung. 


Um herauszufinden, wie viele Versuche zu einem repräsentativen Ergebnis 
führen, wurde eine Stichprobenanalyse auf Basis von 70 Positionierversu- 
chen durchgeführt (siehe Abschnitt 7.1.1). Anschließend wurde die Stan- 
dardabweichung jeder angefahrenen Zielposition untersucht. Für die Stich- 
probenanalyse wurde aus den einzelnen Standardabweichungen die gewählt, 
welche den größten Betrag aufwies und somit die Position mit der größten 
Ungenauigkeit widerspiegelte. Als Fehlergrenze wurden 5 mm festgelegt. 
Daraus ergab sich die minimale Anzahl an zu fahrenden Versuchen pro Ziel- 


position von 
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1,96? - 0,013? 
Se Ns 6... 7.31 
ne mise = a 


7.5.3 Ergebnisse der Positionierversuche 


Die Ergebnisse der einzelnen Messfahrten sind in Abbildung 7.31 darge- 
stellt. Insgesamt wurden 375 Positionen angefahren und ausgewertet. Die 
exakte Anzahl (N) mit der jede einzelne Zielposition angefahren wurde, so- 
wie der durchschnittliche Fehler mit dessen Standardabweichung, sind in 
Tabelle 7.13 aufgelistet. Da die Standardabweichungen im Verhältnis zu den 
durchschnittlichen Fehlern sehr groß ausfallen, wurde als weiteres Maß der 
90%-Fehler eingeführt. Er spiegelt die Abweichungen wieder, die mit einer 
Eintrittswahrscheinlichkeit von 90% auftreten. 

Über alle Punkte hinweg ergibt sich bei einer Eintrittswahrscheinlichkeit 
von 90% eine Abweichung von 6,15 cm. Eine detaillierte Darstellung der 
Abweichungen an den einzelnen Zielpositionen ist in Abbildung 7.32 in 


Form von BoxPlot-Diagrammen dargestellt. 


Tabelle 7.13: Ergebnisse der einzelnen Messfahrten für alle angefahrenen Positionen. 


Pos. N mittlerer Fehler [cm] emp.Stand. [cm] 90%-Fehler [cm] 
Pos. 1 68 4,1 2;3 6,6 
Pos. 2 64 3,0 1,8 5,7 
Pos. 3 76 3,2 3,1 5,6 
Pos. 4 59 3.3 1,7 5,6 
Pos. 5 51 3,0 1,6 5,2 
Pos. 6 57 33 1,9 5,6 
Gesamt 375 3,3 1,9 5,8 
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Abbildung 7.32: Anzahl der Anfahrten jeder Zielposition 


7.6 Zusammenfassung und Diskussion 


Aus den Ergebnissen kann abgeleitet werden, dass die Positionen über alle 
Zielpunkte hinweg mit einer annähernd gleich großen Genauigkeit angefah- 
ren werden können. Bei einem durchschnittlichen Fehler von 3,3cm und ei- 
nem Fehler von 5,8cm bei einer Eintrittswahrscheinlichkeit von 90%, kann 
geschlossen werden, dass das Anfahren von Übergabestellen trotz niedriger 


Sensorauflösung möglich ist. 
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Im Rahmen der vierten industriellen Revolution ist die Automatisierung und 
die Digitalisierung von Prozessen aktuell in vollem Gange. Doch nicht je- 
de Firma kann mit der voran schreitenden Modernisierung von Poduktions- 
abläufen und Materialflüssen schritthalten. Speziell kleine und mittelständi- 
sche Unternehmen sind auf Grund hoher Investitionskosten nicht dazu in der 
Lage ihre Prozessabläufe zu modernisieren. Kürzer werdenden Lebenszy- 
klen ist es geschuldet, dass Unternehmen in Zukunft möglichst flexibel auf- 
gestellt sein müssen. Produktion und Materialfluss müssen schnell an sich 
ändernde Randbedingungen angepasst werden können. Hier können fah- 
rerlose Transportsysteme hilfreich sein. Doch obwohl es schon seit vielen 
Jahren ein großes Angebot an fahrerlosen Transportsystemen gibt, setzten 
viele Unternehmen weiterhin auf starre, fest installierte Materialflusssyste- 
me. Zwei Gründe dafür sind einerseits die hohen Kosten für hochflexible 
und frei navigierende Systeme und andererseits ein unzureichendes Maß an 
Flexibilität bei günstigen Systemen. 

Mit dieser Dissertation wurde ein kommunikationsgestütztes Lokalisie- 
rungssystem erforscht, welches den Einsatz günstiger fahrerloser Transport- 
systeme ermöglicht und diese lokal hochflexible agieren lässt. Das System 
basiert auf einer externen Sensoreinheit, welche oberhalb des Fahrbereiches 
unter der Hallendecke installiert wird und diesen mit Hilfe einer Tiefenbild- 
kamera überwacht. Objekte innerhalb des Bereichs werden detektiert, ana- 
lysiert jedoch nicht identifiziert. Die Identifikation der einzelnen Fahrzeuge 
führen diese selbst durch. Hierfür greift das Fahrzeug über eine Kommu- 


nikationsschnittstelle auf die vom Sensorsystem ermittelten Objekteigen- 
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schaften zu und vergleicht diese mit den eigenen Fahrzeugparametern. Auf 
Basis eines probabilistischen Ansatzes kann die Wahrscheinlichkeit berech- 
net werden, mit der es sich bei dem betrachteten Objekt um das gesuchte 
Fahrzeug handelt. Ein Vorteil dieses Systems ist, dass alle Informationen zu 
allen Objekten vom Sensorsystem veröffentlicht werden. Fahrzeuge können 
demnach nicht nur ihre eigene Position feststellen, sondern haben Kenntnis 
über die Positionen und Formen aller Objekte im überwachten Bereich. Dies 
ermöglicht sowohl eine freie Navigation, als auch das Ausweichen bei der 
Begegnung mit anderen Verkehrsteilnehmern oder Hindernissen. 

Aus der anfänglichen Problemstellung wurden zu Beginn der Arbeit drei 


Forschungsleitende Fragen abgeleitet: 


e Ist die Umsetzung eines kommunikationsgestützten Lokalisierungs- 
systems möglich? 

e Welche Informationen müssen übermittelt werden? 

e Wie gut funktioniert ein solches System? 
Insbesondere, welche Genauigkeit weist die Positionierung auf 


und welche Geschwindigkeiten können sicher gefahren werden? 


Mit dem Ziel der Beantwortung dieser Fragen, wurde der Prototyp eines Ka- 
merasystems, basierend auf einer Tiefenbildkamera und einer Auswerteein- 
heit entwickelt und an der Decke oberhalb einer Versuchsfläche installiert. 
Anschließend wurden damit die Rohdaten des Kamerasystems analysiert 
und ein Ausgleich einer Kameraschiefstellung implementiert. Die Analyse 
der Rohdaten ergab, dass diese einem starken Rauschen unterliegen. Um die 
Objekte vom Hallenboden unterscheiden zu können, wurden alle Messwerte 
entfernt, die sich auf Höhe des Hallenbodens oder knapp darüber befinden. 
Vom System erkannt werden Objekte mit einer Mindesthöhe von 75 mm. Da 
dennoch bei einer große Anzahl an Messungen, auf Grund stark verrausch- 
ter Messwerte, die Mindesthöhe fälschlicherweise überschritten wird, wurde 


eine Rauschunterdrückung entwickelt und implementiert, mit der die An- 
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zahl an Fehlmessungen nochmals deutlich reduziert werden konnte. Nach 
der Segmentierung der Objekte, unter Verwendung eines eigens entwickel- 
ten Extraktionsansatzes, wurden die gefundenen Objekte auf ihre kinemati- 
schen und geometrischen Eigenschaften hin untersucht. Für eine erfolgrei- 
che Identifikation durch die Fahrzeuge, hat sich die Ermittlung der folgen- 
den Eigenschaften als zielführend herausgestellt: 


e Position 


e Status 


Geschwindigkeit 


Orientierung 
e Höhe 

e Fläche 

e Umfang 


Geschätzte Position (intern) 


e Geschwindigkeit (intern) 


Orientierung (intern) 


Die Lokalisierung lässt sich in drei Hauptherausforderungen zunehmenden 


Schwierigkeitsgrades unterteilen. 


e Die Positionsverfolgung, 
e die globale Lokalisierung und 
e das kidnapped Robot-Problem. 


Basierend auf dem Ansatz der Markov-Lokalisierung wurde eine probabi- 
listische Selbsterkennung entwickelt und implementiert, die eine Lösung 
der ersten zwei Probleme ermöglicht. Eine Verwechslung zweier Fahrzeuge 
garantiert zu erkennen, kann jedoch allein mit dem Lokalisierungssystem 
nicht geleistet werden. Dafür muss zukünftig auf erweiterte Methoden zu- 
rückgegriffen werden. 

Abschließend wurde das System einer Vielzahl von Tests unterzogen. Nach- 


dem in vorbereitenden Versuchen die besten Parameter positionierrelevanter 


167 


8 Zusammenfassung 


Filter erhoben, ausgewertet und implementiert wurden, konnten die maxi- 
male Geschwindigkeit, mit der sich ein Fahrzeug innerhalb des überwachten 
Bereiches bewegen darf und die dazu gehörige Positioniergenauigkeit ermit- 
telt werden. Darüber hinaus wurde ein Referenzmesssystem installiert und 
bewertet. Es hat sich herausgestellt, dass die Geschwindigkeit in großem 
Maße von der Dauer der Erkennungsprozesse, der Bildrate, der Rauschun- 
terdrückung und der Datenübertragung abhängt. In 95% der Fälle liegt die 
Reaktionszeit bei der hier verwendeten Sensoreinheit bei 0,26 Sekunden. 
In Kombination mit einem maximal zulässigen Positionierfehler von 15cm 
ergibt sich eine zulässige Maximalgeschwindigkeit von 0,577 m/s. 

Die Auswertung von sechs zuvor definierten Zielpositionen, welche insge- 


samt 375-Mal angefahrenen wurden, ergab einen durchschnittlichen Fehler 


von +3,5cm. 95% aller Fehler lagen unterhalb von +5,8cm. Es konnte 
kein eindeutiger Zusammenhang zwischen der Größe des Fehlers und der 
Position innerhalb des überwachten Bereich hergestellt werden, wodurch 
davon ausgegangen werden kann, dass im Rahmen des untersuchten Be- 
reichs die Positionsgüte konstant ist. 

In Anlehnung an die Resultate wurden alle forschungsleitenden Fragen 
beantwortet. Es wurde nachgewiesen, dass eine kommunikationsgestütz- 
te Lokalisierung umsetzbar ist, welche Informationen für eine erfolgreiche 
Selbsterkennung der Fahrzeuge zur Verfügung stehen müssen und wo die 
aktuellen Grenzen des System in Bezug auf Geschwindigkeit und Positio- 


niergenauigkeit liegen. 
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Nach der Beantwortung der forschungsleitenden Fragen und der Zusam- 
menfassung der Ergebnisse dieser Dissertation, wird folgend auf deren 
Grenzen und auf weiterreichende Fragestellungen hingewiesen. Die An- 
wendung des Lokalisierungssystems im realen Umfeld führt auch dazu, 
dass für die Fahrzeuge Verhaltensregeln implementiert werden müssen, so- 
bald sie in einem Raum mit mehreren bewegten Objekten und Personen 


interagieren, worauf in einem zweiten Abschnitt kurz eingegangen wird. 


Bei dem hier erforschten kommunikationsgestützten Lokalisierungssystem 
wurden die Grenzen bezüglich der Positioniergenauigkeit und der maximal 
fahrbaren Geschwindigkeit noch nicht erreicht. Folgend sind einige weiter- 
führende Maßnahmen erklärt, die das Gesamtsystem seiner Funktionsgren- 


ze etwas näher bringen. 


e Die Feinpositionierung wurde entwickelt und implementiert und stich- 
probenartig untersucht und getestet. Obwohl sich bereits abgezeichnet 
hat, dass sich die Positioniergenauigkeit mittels der Feinpositionie- 
rung nochmals deutlich erhöhen lässt, müssen eingehendere Untersu- 
chungen durchgeführt werden, um die absoluten Grenzen charakteri- 
sieren zu können. 

e Eine Erhöhung der Navigationsauflösung von 256 x 212 auf 512 x 424 
Knoten kann die Positioniergenauigkeit zusätzlich erhöhen. 

e Das System wurde bisher unter Verwendung einer Tiefenbildkamera 
getestet. Eine Untersuchung weiterer alternativer Kamerasysteme ist 


sinnvoll, da sich diese in Hinblick auf Auflösung und Fehleranfällig- 
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keit von der hier verwendeten Kinect 2 Kamera unterscheiden und die 
Systemleistung weiter verbessern können. 

Im Laufe der Untersuchungen hat sich gezeigt, dass die Oberflächen- 
beschaffenheit der Objekte direkte Auswirkungen auf die Güte der 
Messwerte hat. Eine Untersuchung der Korrelation hilft Fehler zu mi- 
nimieren und die Güte der Messwerte zu erhöhen. 

Die Erhöhung der maximal fahrbaren Geschwindigkeit ist von hoher 
Relevanz. Durch eine weiterführende Optimierung der Erkennungs- 
und Filteralgorithmen könnte die Verarbeitungszeit des Sensorsys- 
tems reduziert werden. Dies führt wiederum zu einer Verringerung 
der Gesamtlatenz und dadurch zu einer Erhöhung der Maximalge- 
schwindigkeit. Theoretisch sind mit dem hier verwendeten System- 


aufbau Geschwindigkeiten von über 1,2 m/s möglich. 


Nachdem im vorausgegangenen Abschnitt einige prozessverbessernde Maß- 


nahmen vorgestellt wurden, wird folgend auf den Einsatz des Systems in 


realitätsnaher Umgebung betrachtet. 


Sobald die Fahrzeuge in einer Umgebung navigieren, in der noch andere 


sich bewegende Objekte wie andere Fahrzeuge außerhalb und innerhalb des 


Navigationssystems aber auch Menschen vorkommen, müssen für Begeg- 


nungen und Interaktionen Regeln vorprogrammiert sein. 
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Begegnung einer Person. Sobald das Fahrzeug in die Nähe einer 
Person fährt, sollte es sich passiv verhalten. Es sollte mit speziel- 
ler Sensorik darauf geachtet werden, dass es seine Geschwindigkeit 
den (plötzlichen) Bewegungsabläufen des Menschen anpasst bzw. im 
Notfall anhält. In diesem Zusammenhang sollte die Sicherheit der 
kommunikationsgestützten Lokalisierung untersucht werden. 

Begegnung mit anderem Fahrzeug. Begegnet das Fahrzeug einem an- 
deren, so könnte ein „Rechtsfahrgebot,, implementiert werden, die 
Fahrzeuge fahren also nach einer vordefinierten Richtung aneinander 


vorbei, können so im Fluss bleiben ohne eine Kollision zu riskieren. 


9 Ausblick 


Kann das Fahrzeug ein bewegtes Objekt nicht dem Navigationssystem 
zuordnen, so könnte passiv nach einem vordefinierten Bewegungs- 


muster ausweichen. 


Selbsterkennung. Obwohl die Selbsterkennung entwickelt, imple- 
mentiert und stichprobenartig untersucht und getestet wurde, sind 
eingehende Untersuchungen in einen realen Umfeld notwendig, um 
eine repräsentative Aussage über dessen Zuverlässigkeit treffen zu 
können. 

e Verwechslungsgefahr mit anderem Fahrzeug. Besteht die Wahrschein- 
lichkeit, dass das Fahrzeug sich nicht mehr sicher einem Objekt in- 
nerhalb des Kamerasystems zuordnen kann, so könnten feste Bewe- 
gungsmuster oder Routinen implementiert werden, die das Fahrzeug 


abarbeitet, bis es sich wieder selbst sicher zuordnen kann. 


Mit diesen hier aufgezeigten Erweiterungs- und Anwendungsmöglichkeiten 
wurden Wege aufgezeigt, wodurch sich das erforschte Lokalisierungssystem 
in bestehende Arbeitsläufe integrieren lässt. Das System kann nach und nach 
weiterentwickelt und so auch an zukünftige Herausforderungen angepasst 
werden. Mit dieser Arbeit konnte ein Beitrag geleistet werden den Auto- 
matisierungstrend nicht nur für große Unternehmen zugänglich zu machen, 
sondern auch kleinen und mittelständigen Firmen zu ermöglichen ihren Ma- 
terialfluss zu automatisieren. Der Zugang zu und die Verwendung von kos- 
tengünstigen fahrerlosen Transportsystemen wird in Zukunft zu einer Viel- 
zahl an neuen Fragestellungen führen und Türen zu neuen Forschungsge- 


bieten eröffnen. 
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Eine längere Glättung der aus den Sensordaten ermittelten Ori- 
entierung führt zu kleineren Fehlern, aber auch zu einer größe- 
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Orientierung korrigiert werden. Der durch Fehlerfortpflanzung 
entstehende odometrische Fehler ist auf kurze Distanzen ver- 
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Kurvenfahrtparameter. .. 2.2.22 oo nn 
Darstellung eines Ausschnitts aus den aufgezeichneten Mittel- 
punktpositionen, während der Fahrt des Versuchsfahrzeuges. Es 
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len „zurück“ springt, obwohl das Fahrzeug mit konstanter Ge- 
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Resultierende Standardabweichungen bei angepasstem und kon- 
stanten Glattungsfaktor (schwarz) und bei fehlendem Glättungs- 
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Mit dem Ziel, ein spurgeführtes fahrerloses Transportfahrzeug lokal hochflexibel 
und frei navigieren zu lassen, wurde im Rahmen dieser Arbeit ein neuartiges, auf 
Entfernungsmessungen basierendes, kommunikationsgestütztes Lokalisierungs- 


system entwickelt, erforscht, praktisch umgesetzt und evaluiert. 


Mit Hilfe einer Tiefenbildkamera, welche an der Decke einer Halle montiert ist, 
wird der Bereich unterhalb der Kamera erfasst und von einer Auswerteeinheit 
analysiert. Das Sensorsystem ist in der Lage Objekte innerhalb des digitalen 
Sichtfeldes zu erkennen, sie auf deren kinematische und geometrische Eigen- 
schaften hin zu untersuchen und die gesammelten Informationen über eine 
Kommunikationsschnittstelle zu veröffentlichen. Da eine Identifizierung der ein- 
zelnen Fahrzeuge mit Hilfe des Kamerasystems schwierig umsetzbar ist, wurde 
eine neue Herangehensweise erforscht. Basierend auf einem probabilistischen 
Ansatz konnte eine Methode entwickelt und implementiert werden, die es den 
einzelnen Fahrzeugen erlaubt, auf die kommunizierten Eigenschaften zuzugreifen 
und sich selbst zu identifizieren. Ein Vorteil des neuen Ansatzes ist die Unabhän- 
gigkeit von Form, Farbe und Größe der Fahrzeuge. Darüber hinaus erhält jedes 
Fahrzeug nicht nur die Informationen über sich selbst, sondern über alle Objekte 
im Sichtbereich der Kamera. 
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